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the  continuous  measurement  and  evaluation  can  be  related  to  the  summary 
measure, each  control  action  can  be  evaluated  as  an  entity,  as  well  as,  part  of 
the  total  control  problem. 
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The  desired  continuous  performance  measure  (CPM)  provides  a continuous 
indication  of  the  correct  motion  of  the  aircraft  at  each  point  in  a mission 
segment  and  what  is  also  important,  an  indication  of  the  significance  of  any 
motion  errors  with  respect  to  the  summary  measure  performance  selected.  This 
application  of  the  continuous  performance  measure  is  termed  the  "Mission  Model' 
since  the  model  can  provide  both  reference  aircraft  motion  and  an  evaluation 
of  the  flight  control  errors.  The  objective  of  the  research  reported  here  is 
to  evaluate  the  feasibility  of  continuous  performance  measures  for  aircraft 
systems,  and  the  development  of  the  necessary  computational  tools. 

This  report  provides  a description  of  the  test  mission,  missiloy.  segments , 
and  segment  specifications.  A mathematical  model  for  the  aircraft*  dyttamlcs 
along  with  the  development  of  the  continuous  performance  measure  for  Emission 
segment  are  Included.  A computational  technique  for  solving  the  CPM  for  a 
mission  segment  is  also  Included. 


WS 

DOC 

BNdWO'ii'tOE* 

KoUMCATM*. 


SECURITY  classification  of  this  PAGErWi«n  D*l«  Bnftmd) 


summary 


Man-in-the-loop  simulation  is  used  both  to  evaluate 
proposed  system  designs  and  to  train  new  operators.  Historically, 
measures  of  the  man's  performance  have  often  been  confounded  with 
measures  of  the  system  he  is  asked  to  control.  While  the  intent  has 
been  to  get  a measure  which  has  operational  meaning  and  predictive 
validity,  confounding  system  performance  with  operator  performance 
can  obscure  important  information.  The  intent  here  was  to  explore  the 
feasibility  of  developing  a measure  that  would  provide  a better  scoring 
procedure  for  manned  system  simulation,  whether  for  research  or 
training:  a procedure  which  reflected  the  impact  of  inappropriate 

operator  action  which  did  not  also  include  penalties  for  factors  beyond 
the  operator's  control.  For  example,  summary  measures  such  as 
RMS  error  or  integrated  absolute  error  can  confound  operator  control 
actions  with  turbulence  induced  excursions  from  a desired  flight  path. 

Also,  summarized  measures  do  not  provide  any  guidance  as  to  how  one 
makes  the  best  of  a bad  situation.  They  do  not  prescribe  a desired  or 
appropriate  course  of  action  sensitive  to  the  objectives  of  the  task  and 
conditional  upon  the  circumstances  prevailing  when  action  is  required. 

Optimal  control  theory  was  used  as  the  basis  for  formulating 
the  continuous  performance  measurement  approach  developed  here.  The 
original  goal  was  to  develop  a measure  that  was  sensitive  to  the  infoi — 
mation  displayed  to  the  operator  so  one  could  "assign  cause"  for 
inappropriate  actions  taken  by  the  operator.  It  was  also  desirable  to 
develop  the  measure  for  all  segments  of  the  mission.  It  was  soon 
discovered  that  such  ambitions  were  beyond  the  scope  of  this  effort  and 
attention  was  devoted  to  simpler  issues  and  a single,  well  defined  mission 
segment.  The  report  documents  the  overall  mission  analysis  but  develops 
the  performance  measure  only  for  the  cruise  phase. 

One  of  the  impediments  was  the  problem  context  chosen  for 
study.  The  optimal  control  theory  requires  the  formulation  of  an  explicit 
model  in  order  to  define  what  actions  are  appropriate  if  one  wishes  to 
achieve  specified  objectives.  The  model  includes  a description  of  the  task 
the  operator  is  asked  to  perform.  Since  the  measure  would  potentially  be 
applicable  to  a planned  series  of  experiments,  the  model  of  the  aircraft 
control  task  used  to  develop  the  continuous  performance  measure  was 
borrowed  directly  from  the  real-time  simulation  program  developed  for 
those  studies. 


This  report  describes  the  mission  that  was  of  interest  and 
rationalizes  the  model  proposed  for  experimental  studies.  While  the 
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specifics  of  the  continuous  performance  nrteasure  developed,  implemented, 
and  briefly  studied  here  are  based  upon  that  mission  and  aircraft  model, 
the  general  philosophy  and  approach  are  believed  to  be  applicable  to  a broad 
class  of  problems . The  specifics  of  the  continuous  performance  measure 
appropriate  for  these  other  applications  will  require  a similar  development: 
quantification  of  mission  objectives,  descriptive  modeling  of  the  task  (the 
aircraft  or  plant  dynamics),  derivation  of  the  optimal  feedback  control  law 
(including  solution  techniques  appropriate  to  whatever  model  is  developed), 
and  finally,  the  construction  and  implementation  of  the  continuous  perfor- 
mance measure. 

Additional  work  will  be  required  to  explore  the  unanswered 
questions  and  to  gain  experience  with  these  measures  in  contrasting  them 
with  the  more  conventional  measures  now  employed.  While  their  utility 
in  human  factors  research  was  the  original  justification  for  the  develop- 
ment of  continuous  performance  measures,  they  also  appear  attractive 
as  measures  useful  in  a training  environment  where  an  instructor  wishes 
to  single  out  appropriate  and  inappropriate  student  actions,  calling  attention 
to  the  impact  these  actions  have  on  mission  effectiveness. 

The  findings  of  this  study  substantiate  the  feasibility  of 
I developing  a continuous  performance  measure.  Unfortunately,  they  also 

I confirm  the  "curse  of  dimensionality"  alluded  to  by  Bellman:  complicated 

problems  lead  to  tedious  calculations  if  solvable  at  all.  The  measure  as 
presented  in  this  report  is  not  calculable  in  real-time  as  had  been  desired, 
but  insight  has  been  gained  that  may  lead  to  more  practical  and  faster 
solutions  if  not  an  entire  new  approach.  Until  further  experience  is  gained 
in  applying  the  technique,  no  conclusions  can  be  made  about  the  total  merits 
of  the  method.  While  the  results  were  inconclusive,  they  should  encourage 
further  development,  particularly  for  mission  phases  not  treated  here. 
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INTRODUCTION 


1 .0 


A performance  measurement  concept  typically  employed  for 
manual  control  systems  uses  a summary  measure  which  provides  a single 
numerical  score  to  represent  performance  of  the  total  control  problem. 

While  summary  measures  are  necessary  for  evaluating  total  problem 
performance,  for  instance,  in  comparing  performance  of  competitive 
systems,  summary  measures  do  not  reveal  performance  information  about 
control  actions  that  occur  during  the  control  problem.  If  performance  can 
be  measured  and  evaluated  continuously  throughout  the  control  problem, 
each  control  action  (or  series  of  actions),  whether  continuous  or  discrete 
can  be  evaluated  rapidly  and  thus  individually.  Also,  if  the  continuous 
measurement  and  evaluation  can  be  related  to  the  summary  measure 
thereby  indicating  the  effect  of  a control  action  on  the  associated  summary 
measure,  each  control  action  can  be  evaluated  as  an  entity,  as  well  as, 
part  of  the  total  control  problem.  This  performance  measurement  concept 
specifically  permits  identification  and  evaluation  of  the  significance  of 
operator  error  patterns,  and  identification  of  critical  and  sensitive  regions 
of  the  control  problem. 

This  type  of  measure  - a continuous  performance  measure 
(CPM)  - is  a tool  which  the  authors  believe  could  be  used  to  increase  the 
efficiency  of  experiments,  training,  and  design  of  manual  control  systems. 
For  example,  the  tool  can  allow  evaluation  of  experimental  results  on  a 
portion  of  a control  problem  with  respect  to  the  effect  on  the  total  mission. 
Rapid  evaluation  of  control  errors  can  facilitate  training  efficiency,  and 
knowledge  of  control  sensitivity  to  total  mission  performance  permits  con- 
centration of  design  effort  on  critical  areas.  This  report  documents 
research  on  a method  of  continuous  performance  evaluation  of  manual 
flight  control  systems. 

The  desired  CPM  provides  a continuous  indication  of  the 
correct  motion  of  the  aircraft  at  each  point  in  a mission  segment  - thus 
providing  flight  criteria  against  which  actual  aircraft  motion  can  be  com- 
pared - and  what  is  also  important,  an  evaluation  of  the  significance  of 
any  motion  errors  with  respect  to  the  summary  performance  measure 
selected.  This  application  of  continuous  performance  measurement  is 
termed  "Mission  Model"  since  the  model  can  provide  both  the  reference 
aircraft  motion  and  an  evaluation  of  flight  control  errors.  The  objective 
of  the  research  reported  here  is  to  investigate  the  feasibility  of  continuous 
performance  measure  for  aircraft  systems,  and  demonstrate  the  development 
of  the  necessary  computational  tools. 
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The  mission  model  considered  here  is  based  on  an  optimal 
control  concept  which  relates  performance  during  the  mission  to  summary 
performance.  When  a summary  measure  is  selected  for  a mission  or 
mission  segment,  optimal  control  theory  can  be  used  to  determine  for 
each  aircraft  state  in  the  mission  segment,  the  optimal  control  and 
associated  optimal  solution  trajectories . The  term  "optimal  solution 
trajectories"  used  here  means  the  aircraft  motion  trajectories  that 
minimize  the  summary  performance  measure  selected  for  the  mission 
segment.  Also  the  term  "aircraft  state"  refers  to  a set  of  state 
variables  that  provide  a complete  description  of  the  aircraft  (to  the 
extent  it  is  represented  by  the  aircraft  model  used)  by  identifying  values 
for  all  positional  and  rotational  variables,  as  well  as,  their  velocities. 

In  order  to  understand  how  optimal  control  theory  can  be 
used  to  determine  the  instantaneous  effect  of  control  actions  on  the  summary 
measure,  consider  a control  problem,  shown  in  Figure  1 , where  the 
ai rcraft  is  presently  at  Point  A and  the  control  objective  is  to  direct 
the  aircraft  to  Point  B.  When  the  aircraft  reaches  Point  B the  segment 
control  problem  is  completed  and  performance  for  that  segment  is  evaluated 
according  to  the  selected  summary  measure.  Only  those  flights  which 
satisfy  the  control  requirement  by  reaching  Point  B (or  within  a specified 
tolerance)  are  considered  for  scoring.  If  one  (or  more)  solution  trajectory 
from  Point  A to  Point  B incurs  a minimum  value  of  the  selected  summary 
measure,  that  trajectory  (or  those  trajectories)  is  the  optimal  one  sought. 
The  optimal  trajectory,  say  Path  1 of  Figure  1,  may  be  considered  as  a 
reference  path  from  Point  A and  each  point  along  the  path  to  Point  B. 
Optimal  control  theory  is  the  mathematical  tool  that  can  be  used  to  find 
the  optimal  trajectory  from  each  point  in  the  region  of  interest  in  the 
mission  segment. 

To  determine  what  control  is  "optimal"  it  is  necessary  to 
construct  several  model  components.  These  include:  (1)  a representation 

of  the  goal  of  the  current  task  in  terms  of  a set  of  objectives  and  weights 
reflecting  their  relative  importance,  (2)  a representation  of  the  system 
being  controlled,  e.g.,  the  equations  of  motion  for  an  aircraft  of  interest 
(suitably  detailed  for  the  nature  of  the  problem  to  be  addressed),  and 
(3)  a representation  of  the  physical  or  other  constraints  that  limit  where 
the  system  can  go  or  what  controls  can  be  applied.  Mathematical  tech- 
niques are  used  to  solve  this  set  of  models  to  define  a rule  for  choosing 
the  control  which  leads  to  the  "best"  outcome  for  these  given  objectives, 
system,  and  constraints.  Applying  this  rule  leads  to  an  optimal  trajectory. 
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The  theory  assumes  the  objective,  system,  and  constraints  as  mathe- 
matically represented  are  an  accurate  and  complete  description.  To 
the  extent  the  models  fall  short,  so  will  the  theory's  ability  to  meet 
one's  subjective  or  intuitive  notion  of  "optimal."  For  example,  if 
"my"  objectives  differ  from  "your"  objectives  — or  if  we  but  weight 
the  same  objectives  differently,  then  the  theory  produces  a control 
rule  for  "me"  that  may  differ  from  the  control  rule  for  "you."  While 
this  sensitivity  is  often  desirable,  it  is  apparent  that  acceptance  of  the 
defined  "optimum"  requires  concurrence  in  each  element  of  the  model. 

If  agreement  is  not  reached,  the  theory  does  not  apply  except  to  each 
separate  model  proposed , in  which  case  it  must  be  expected  that  the 
results  will  differ  if  the  models  do.  In  short,  what  is  optimal  is 
relative  to  the  associated  models,  and  here  we  must  assume  there  is 
no  argument  with  the  objectives,  system,  and  constraints  as  posed.  If 
there  were  argument,  the  first  step  would  be  to  change  the  models 
proposed  for  whatever  element  was  questioned,  revise  it  appropriately, 
and  then  proceed  with  optimization  with  the  assurance  that  agreement 
was  reached.  The  reader  is  therefore  asked  to  accept  the  models  as 
proposed  simply  to  facilitate  the  subsequent  analysis.  It  is  to  be  under- 
stood that  exceptions  to  the  model  would  demand  reformulations  specific 
to  each  reader's  criticisms  - a task  obviously  impossible  a priori  - 
which  would,  at  least  in  principle,  dispense  with  these  criticisms.  In 
a sense,  criticism  of  the  specific  model  is  peripheral  to  the  main  theme 
of  this  report.  The  emphasis  is  on  an  approach  not  a specific  application 
much  less  a single  result.  On  the  other  hand,  much  of  the  specifics 
developed  here  must  be  repeated  as  the  models  are  changed.  The 
philosophy  is  what  is  general izable . This  report  attempts  to  demonstrate 
the  feasibility  of  implementing  that  philosophy  in  a given  context,  the 
participating  critiques  (namely  the  authors)  having  been  satisfied  - at 
least  at  this  juncture. 

The  optimal  control  analysis  can  also  provide  error  sensi- 
tivity information.  Error  sensitivity  weighting  is  important  because  it 
allows  direct  evaluation  of  control  errors  and  further  reveals  the  regions 
of  high  control  error  sensitivity  in  the  mission  segment.  In  order  to 
see  how  the  error  sensitivity  is  determined,  assume  that  the  pilot  con- 
trolling the  aircraft  at  Point  A does  not  provide  the  correct  control  and 
as  a result  the  aircraft  moves  to  Point  C.  Thereafter,  the  pilot  employs 
optimal  control  directing  the  aircraft  along  the  optimal  path  from  Point  C 
to  Point  B.  Note  that  Path  C-B  can  be  totally  different  from  Path  A-B. 
Except  for  the  control  error  of  short  duration  which  moved  the  aircraft 
from  A to  C,  the  pilot  used  optimal  control . The  difference  between  the 
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summary  measures  for  Paths  1 (the  optimal  solution  from  Point  A to  B) 
and  2 (the  trajectory  from  Point  A to  C and  the  optimal  solution  from 
C to  B)  must  be  the  increase  in  the  summary  measure  due  to  the  initial 
control  error.  There  cannot  be  a decrease  in  the  summary  measure 
since  that  would  imply  that  trajectory  1 is  not  optimal . The  amount  of 
increase  in  the  summary  measure  value  due  to  the  initial  control  error 
is  the  effect  of  the  control  error  on  the  summary  measure.  The  type  of 
mission  model  considered  here  provides  this  sensitivity  weighting  for 
each  incremental  aircraft  motion  and  thus  provides  an  instantaneous 
weighting  of  control  errors. 

Military  aircraft  missions  are  not  usually  defined  solely 
with  a summary  measure,  but  typically  are  defined  by  a flight  profile 
consisting  of  a series  of  flight  maneuvers  along  with  objective  values 
for  appropriate  state  variables  such  as  velocity,  heading,  altitude,  and 
rate  of  climb.  Frequently,  a mission  can  be  segmented  so  that  a con- 
sistent set  of  flight  variable  specifications  can  .be  defined  throughout 
each  segment.  Segments  may  be  and  typically  are  defined  by  a reference 
flight  path  along  which  some  state  variable  values  are  given.  Desired 
terminal  conditions  indicating  the  preferred  state  variable  values  at  the 
end  of  the  segment  may  also  be  available.  The  total  mission  may  be 
viewed  as  a series  of  segments  where  the  end  flight  conditions  of  one 
segment  are  the  initial  conditions  for  the  next  segment.  Thus  in  order 
to  construct  a segmented  Mission  Model,  the  mission  segment  specifi- 
cations must  be  converted  to  a summary  measure  and  any  required 
flight  constraints. 

Conversion  of  mission  specifications  into  a summary  measure 
and  reference  trajectories  requires  construction  of  a penalty  function  (cost 
index  function  in  control  theory  terminology)  which  identifies  the  relative 
importance  of: 

1 . Deviation  from  the  desired  terminal  state,  and 

2.  Variable  rates  of  change,  control  actions,  and 
deviations  from  reference  trajectories  occurring 
along  the  solution  path. 

The  cost  function  is  selected  by  study  of  the  requirements  of  each  mission 
segment.  It  reflects  the  nature  of  the  objectives  for  the  segment  and  the 
relative  importance  of  each.  For  example,  in  some  segments  straight 
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and  level  flight  is  desired  at  a specified  heading,  altitude,  and  velocity. 

In  other  segments  a constant  climb  or  dive  may  be  desired.  In  yet 
other  segments,  more  complex  coordinated  maneuvering  may  be  required. 
The  cost  or  penalty  function  is  constructed  to  incorporate  these  reference 
maneuvers  so  that  if  the  aircraft  flys  along  the  reference  path,  zero 
penalty  is  incurred.  For  instance,  if  constant  altitude  (Z)  and  velocity 
(V)  are  desired,  the  terms 

T 

I = y*  (W^(V-V^^  + W2(Z-Z^)^...)dt 
0 


might  be  used,  where  Vr  and  Zp  are  the  reference  values,  and  , Wg 
are  weighting  values.  This  expression  proposes  that  the  task  objective 
will  be  to  minimize  the  weighted  squared  deviations  or  errors.  These 
weighted  squared  errors  are  then  integrated  (if  time  is  a continuous 
variable,  summed  if  time  were  treated  as  a discrete  variable)  from  the 
start  of  the  segment  (t  = 0)  to  its  end  (t  = T).  The  result  is  a 

single  number  (1). 

The  cost  function  also  evaluates  trajectories  not  along  the 
reference-trajectories,  with  initial  conditions  and  displacements  that 
occur  due  to  control  errors  or  wind  disturbances.  But  recall  that  what- 
ever the  present  state,  there  is  an  optimal  solution  from  that  state  to 
the  terminal  point.  Optimal  solutions  from  points  not  on  the  reference 
trajectories  are  termed  "Preferred  trajectories"  to  distinguish  them  from 
the  reference  trajectories . Calculation  of  preferred  trajectories  is 
accomplished,  as  described  previously,  from  optimal  control  theory 
employing  the  cost  function  and  the  aircraft  equations.  Thus  the  form 
of  the  cost  function  and  the  weighting  constant  values  influence  the 
calculation  of  preferred  trajectories.  The  effect  of  a given  weighting 
term  or  relative  values  of  terms  is  usually  not  known  prior  to  calcu- 
lation of  the  preferred  trajectories . Initial  selection  of  weighting  values 
might  alternatively  be  accomplished  by  asking  experienced  pilots  and/or 
other  personnel  experienced  in  the  mission  performance  requirements  to 
select  weighting  values  or  at  least  order  the  terms  according  to  importan 
to  mission  success.  Thus  selection  of  weighting  values  may  be  an 
iterative  process  involving  initial  weighting  selection,  computation  and 
evaluation  of  preferred  trajectories,  followed  by  an  adjustment  of  the 
weighting  values,  etc. 
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Method  of  Approach 
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1 . 1 


The  mission  selected  for  analysis  is  an  aircraft  operating 
in  a Close  Air  Support  Night  Attack  Mission  where  the  0\/erall  mission 
was  divided  into  segments:  cruising,  climbing,  etc.  Each  segment  of 

the  mission  may  be  considered  as  a separate  problem  in  Itself.  The 
overall  mission  can  be  modeled  as  a sequence  of  sub-problems  which  the 
pilot  must  solve,  where  the  terminal  conditions  of  one  segment  serve 
as  the  initial  conditions  of  the  next  segment.  Individual  segments  are 
then  cast  in  the  form  of  an  appropriate  optimal  control  problem,  the 
solution  of  which  yields  an  optimal  control  law  as  a function  of  the  problem 
state  variables,  i.e.,  feedback  control  law. 


Once  optimal  trajectories  and  the  feedback  control  law 
have  been  obtained  for  a given  segment,  a corresponding  continuous 
performance  measure  (CPM)  function  is  found  for  that  segment.  The 
CPM  gives  an  instantaneous  measure  of  actual  man-machine  system 
performance  as  contrasted  to  preferred  or  optimal  performance. 


The  work  was  divided  into  the  following  subtasks: 

1 . Analysis  of  a Close  Air  Support  Night  Attack  Mission 
to  develop  segments  and  segment  specifications. 


2.  Formulate  a cost  index  for  an  example  mission 
segment. 

3.  Develop  the  optimum  feedback  control  law  for  that 
segment. 

4.  Evaluate  segment  trajectories  using  the  optimal 
feedback  control . 

5.  Develop  the  continuous  system  performance  measure 
and  associated  computer  algorithms. 

6.  Using  the  above  system  performance  measure, 
evaluate  the  segment  performance  using  non- 
optimal  control,  that  is,  use  a non-optimal 
autopilot  model  for  the  feedback  control  law. 

7.  Demonstrate  the  continuous  performance  measurement 
technique. 


14 


Overview  of  Report 
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Section  2 providos  a description  of  the  mission,  mission 
segments,  and  segment  specifications.  The  mathematical  model  for 
aircraft  dynamics  is  given  in  Section  3 along  >A/ith  a description  of  the 
aircraft  state  variables  selected  for  this  problem.  Section  4 contains 
the  development  of  the  continuous  performance  measure  (CPM)  including 
construction  of  CPM  functions,  and  an  illustrative  example.  Section  5 
presents  a specific  application  of  the  method  to  a mission  segment. 
Conclusions  and  recommendations  are  presented  in  Section  6. 
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MISSION  MODELS 


This  section  includes  a description  of  the  Close  Air  Support 
Night  Attack  Mission,  and  a development  of  a mathematical  model  for  the 
mission.  The  mission  was  broken  into  its  segments,  which  can  be  treate 
as  separate  flight  control  problems.  Each  mission  segment  has  its  own 
reference  and  performance  index  functions. 

2 . 1 Close  Air  Support  Night  Attack  Mission 

The  Close  Air  Support  Night  Attack  Mission  was  defined  to 
be  a night/clear  VFR*  attack  against  a power  plant.  Refueling  is  done 
en  route  to  the  target  where  rendezvous  with  a tanker  is  accomplished 
via  UFH/ADF*  procedures.  Missile  evasion  is  done  en  route  to  target 
to  avoid  radar  detection  and  encounters  with  surface-to-air  missiles 
(SAMs).  After  using  FLIR*  to  locate  the  target,  type  MF-84  "dumb 
bombs"  are  dropped.  The  escape  employs  terrain-following  until  the 
forward-edge-of-battle-area  (FEBA)*  is  reached.  TACAN*  navigation 
during  the  penetration  segment  is  followed  by  a GCA  landing  (Figures  2 
and  3 illustrates  the  mission).  The  mission  segments  and  segment 
elements  are  as  follows: 

1 . Preflight  and  Takeoff 

Mission  briefing,  weapons  selection,  aircraft  preflight, 
all  communications  equipment  turned  on,  inertial  system  set  up,  engine 
start  and  systems  checks,  taxi  checks,  pre-takeoff  checks,  arming  com- 
pleted, takeoff  accomplished.  Takeoff  speed  is  140  kts. 

2 . Accelerate  and  Climb 

Gear  and  flaps  retracted,  build  speed  to  330  kts  at 
5,000  ft.,  radar  and  radar  homing  and  warning  receiver  (RHAW)  turned 
on,  TACAN  turned  on,  external  fuel  tanks  turned  on,  checks  of  jammers 
zero  delay  lanyard  unhooked.  After  level  off,  set  power,  and  check  all 
systems.  Climb  speed  is  330  kts. 

3 . Rendezvous  and  Refuel 

Navigate  to  air  refueling  initial  point  with  inertial  systei 
contact  tanker  on  UHF,  and  join  tanker  in  formation  using  UHF/ADF 


*Acronyms  are  defined  in  the  Glossary  for  readers  not  familar  with 
these  terms;  the  Glossary  is  in  Appendix  A. 
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procedures.  Complete  refueling  and  depart  for  target,  navigating  with 
inertial  system. 

4.  Cruise 

Cruise  at  an  altitude  of  18,000  ft.  at  a speed  of  420  kts. 

5.  Missile  Evasion 

Arm  MK-84's  (dumb  bombs).  RHAW  indicates  missile 
threat,  and  ECM  is  turned  on,  successfully  avoiding  the  threat. 

6.  Step  6 was  deleted  from  the  mission. 


7 . Descent  i 

Descend  to  minimum  terrain-following,  VFR  altitude. 

Use  DOPPLER  and  RADAR  for  navigation.  Determine  if  weather  will 
permit  use  of  FLIR  for  target  identification  and  tracking.  Descent  speed 
1 IS  420  kts. 

I 

8 . Dash  (Terrain  Following) 

Turn  on  laser  designator  and  laser  spot  tracker;  maintain 

speed  at  420  kts. 

9.  Pop-up  and  Attack 

! Perform  pop-up  maneuver  to  3,000  ft.,  4 nm  from 

target.  Set  HUD  to  bomb  and  select  proper  armament  switches.  Identify 
target  with  FLIR.  Select  desired  attack  mode.  Make  approach  and 
release  MK-84's,  hitting  the  target. 

I 10.  Escape  Maneuver 

I 

I At  release,  initiate  45°  bank  right  turn,  hold  until  bomb 

impact,  then  pull  into  dive  to  descend  to  terrain  following  (TF)  altitude; 
turn  jammers  to  standby. 

1 1 . Terrain  Following 

Fly  TF  at  350  kts,  using  FLIR.  Navigate  toward  home. 

I 
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12 . Climb  to  Cruise  Altitude 

Start  climb  to  cnjise  altitude  of  18,000;  climb  speed 
is  350  kts.  Check  in  with  GCl  sight  on  UHF,  and  report  mission  results 
to  combat  operations  center  on  HF/SSB.* 

13.  Cruise 

Manage  fuel  and  safety  armament.  Aircraft  is  passed 
from  GCI  to  approach  control.  Pilot  is  cleared  for  TACAN/GCA  approach 
and  landing.  Perform  descent  checklist.  Cruise  speed  is  480  kts. 

14.  Penetration 

Make  TACAN  penetration.  Descent  speed  is  330  kts. 

1 5.  GCA  Landing 

Make  GCA  approach  and  landing.  Landing  speed  is 
140  kts.  Dearm  and  complete  after  landing  checklist.  Debrief  maintenance 
i and  intelligence  personnel. 

f 

The  approximate  average  distance,  average  velocity,  time, 
change  in  altitude  and  rate  climb  are  given  in  Table  1 for  each  segment 
of  the  Close  Air  Support  Night  Attack  Mission.  These  numbers  give  an 
indication  of  the  desired  aircraft  average  performance  for  each  segment 
of  the  mission. 

2.2  Mission  Model 

Each  segment  of  the  overall  mission  can  be  considered  as  a 
, .1  mission  itself  with  its  own  performance  index,  reference  functions  (when 

specified),  and  terminal  conditions.  The  pilot  can  fly  each  segment  of 
’ mission  as  a separate  problem  where  the  terminal  conditions  of  one 

'•*“  ^ segment  are  the  initial  conditions  of  the  next  segment.  The  overall 

•)  mission  problem  is  considered  to  be  the  sequenced  collection  of  pro- 

j blems  from  the  segments.  Table  2 lists  the  terminal  conditions,  possible 

1 reference  functions,  inequality  constraints,  and  performance  factors  for 

each  segment  of  the  Close  Air  Support  Night  Attack  Mission. 

The  performance  factors  are,  in  general,  different  for  each 
segment  of  the  mission,  however,  the  segments  can  be  classified  into  a 
few  categories.  The  first  is  the  climbing  or  descending  type  segment 


*See  Glossary,  Appendix  A 
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TABLE  2 GENERAL  CONSTRAINTS  ON  RATES  AND  ANGLES  (CONTD) 


where  the  objective  is  to  reach  some  terminal  altitude,  or  velocity 
and  altitude,  while  the  performance  is  evaluated  by  comparing  actual 
trajectories  with  reference  trajectories . A second  type  of  segment  is 
the  cruising  segment.  In  this  type  of  segment  the  performance  is 
evaluated  based  on  how  well  the  pilot  maintains  specified  altitude, 
heading  and  velocity  while  reaching  the  terminal  position.  A third 
type  of  segment  is  a prescribed  maneuver,  which  could  include  escape 
maneuvers,  refueling  maneuvers,  and  possibly  pop-up  and  attack 
maneuvers.  Finally,  a fourth  type  of  segment  is  terrain  following  where 
desired  performance  requires  completing  the  segment  in  minimum  time 
and  maintaining  a minimal  distance  above  the  ground. 

Differences  between  segments  of  the  same  type  would 
occur  in  the  initial  conditions,  terminal  conditions,  and  possibly  the 
inclus.on  of  inequality  constraints.  Although  each  typical  segment  of 
the  mission  appears  to  be  quite  different,  a generalized  performance 
index  common  to  many  segments  can  be  used.  Equation  2.1  is  the 
proposed  generalized  performance  index. 


J = 


= cxrCV  - ^ 


/ 1 


(Xpj(t)  - X(t)  ) Q (X^(t)  - X(t)  ) 


T 


+ (Uj^(t)  - U(t)  ) R (U^(t)  - U(t)  ) 


+ (X(t)  W (X(t)  )|  dt 


(2.1) 


This  is  a measure  of  performance  over  a segment,  where  tf  is  the  final 
time,  X is  the  vector  of  state  variables  of  the  system,  U is  a vector 
of  control  variables  of  the  system,  and  S,  W,  Q,  and  R are  weighting 
matrices  which  can  be  selected  by  the  method  described  in  the  intro- 
duction. Xp(t)  is  the  reference  state  and  Up(t)  is  the  control  in  that 
reference  state.  The  generalized  performance  index  is  made  up  of  a 
term  that  weights  the  difference  of  the  state  variables  from  a specified 
reference  state,  penalizes  excessive  control,  and  penalizes  high  rates 
of  change  of  the  state  variables,  effectively  suggesting  "smooth" 
transitions  in  changing  states.  Another  term  might  also  be  added  to 
penalize  "jerky"  control  actions,  but  since  the  optimal  feedback  control 
law  will  define  the  control  rule  as  a function  of  states,  the  penalty 
(W)  on  state-change  rates  (X)  serves  virtually  the  same  purpose. 
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The  difference  between  the  performance  index  for  a 

cruise  segment  and  a climbing  segment  could  be  reflected  in  differences 

in  the  weighting  matrices,  reference  functions  and  terminal  conditions. 

Essentially,  the  performance  index  is  chosen  such  that  the  resulting 

optimal  paths  (solution  trajectories)  represent  the  desired  flight  path. 

If  a flight  path  is  specified  as  virtually  mandatory  (very  high  penalty 

weights  on  errors  or  excursions  from  that  path),  then  that  reference 

path  is  "optimal."  Thus  the  optimal  control  forces  the  desired  path 

to  be  reference  path.  The  distinction  between  "desired"  and  "reference" 

paths  arises  from  not  being  able  to  maintain  the  reference  path  due  to 

other  perturbing  factors  (e.g.  turbulence).  Then  the  optimal  path  may 

not  be  identical  with  the  reference  path  once  the  segment  has  begun 

(i.e. , t > t ). 

o 


3.0  MATHEMATICAL  MODEL  OF  AIRCRAFT  DYNAMICS 

General  mathematical  models  of  the  dynamics  of  an 
aircraft  moving  through  the  atmosphere  have  been  developed  for  use  in 
simulations  and  design  of  aircraft  control  systems  (e.g.,  Etkin,  1972 
and  Fogarty  and  Howe,  1969).  For  purposes  of  this  analysis,  the 
aircraft  is  modeled  by  the  simplified  equations  for  aircraft  dynamics 
contained  in  the  subroutine  ADCOMP  from  the  ALL  DIGITAL  COCKPIT 
DISPLAY  SYSTEM  PROGRAMS  obtained  from  the  Human  Engineering 
Division,  Aerospace  Medical  Research  Laboratory,  Wright-Patterson 
Air  Force  Base,  Ohio.  This  aircraft  model  was  derived  as  a first 
attempt  to  provide  a fairly  reasonable  and  realistic  task  to  relatively 
naive  subjects.  For  non-flyers  it  is  a demanding  task  and  believable. 

For  flyers  and  knowledgeable  engineers,  the  simulation  is  anything  but 
real  and  represents  an  expedient  compromise  to  obtain  a workable  set 
up  for  controlled,  laboratory  experiments.  Since  the  current  effort 
was  focused  on  developing  a new  technique  for  scoring  performance, 
the  CPM  methodology  has  been  developed  for  this  artificial  aircraft: 
the  ADCOMP  subroutine.  The  rationale  for  this  decision  is  that  once 
developed,  initial  experience  with  CPM  can  be  gained  as  real-time 
laboratory  experiments  are  conducted  using  the  ADCOMP  driven  simula- 
tions. For  other  simulations  or  for  real  aircraft,  a more  elaborate 
model  would  have  to  be  defined  (and  parameter  values  determined) 
specific  to  that  application.  Since  ADCOMP  was  not  documented  by  its 
developer,  an  attempt  is  made  here  to  rationalize  the  given  design  of  the 
aircraft  model . 

3. 1 Assumptions 

For  the  model  of  the  aircraft  incorporated  in  the  equations 
of  the  given  ADCOMP  subroutine,  the  following  assumptions  apply. 

• The  aircraft  is  traveling  at  a speed  less  than  MACH  3, 

• The  thrust  vector  is  aligned  with  the  fuselage 
reference  line. 

• The  vehicle  is  a rigid  body  having  a plane  of 
symmetry,  i.e.,  the  right  side  of  the  aircraft 
is  configured  the  same  as  the  left  (i.e.,  same 
size,  weight  and  shape  of  components  and 
attachments  - fuel  pods,  weapons,  etc.)*. 


I *While  this  is  true  in  many  cases,  it  may  not  be  true  for  some  segments 

> I where  a weapon  releases  from  one  wing  but  none  from  the  other. 


• The  atmosphere  is  at  rest  relative  to  the  earth, 
i.e.,  the  wind  is  zero, 

• The  earth  is  considered  a plane  fixed  in  space, 
i.e.,  a flat  earth, 

• The  reference  axes  are  a north,  east  and  down  system 
fixed  to  the  earth, 

• The  side-slip  angle  is  neglected,  i.e.,  assumed 
to  be  zero, 

• The  aircraft  is  assumed  to  be  a point  mass,  in 
that  moments  of  inertia  are  ignored, 

• The  rate  of  change  of  roll  angle  is  approximately 
proportional  to  stick  position, 

• The  equations  describing  angular  acceleration  are 
neglected, 

• The  rate  of  change  of  the  angle  of  attack  is  approxi- 
mated as  being  proportional  to  stick  position  plus  a 
term  due  to  lift, 

• The  reference  frame  for  the  aircraft  is  a combined 
wind  and  body  axes  system,  and 

• The  rudder  is  automatically  set  to  give  coordinated 
turns . 

Under  the  assumptions  given  above,  the  very  complicated 
set  of  equations  for  aircraft  dynamics  given  on  Pages  149-150  of  Anderson 
and  Moore  (1971)  reduce  down  to  the  simplified  set  of  equations  used  in 
the  ADCOMP  subroutine.  Generally,  these  assumptions  are  valid  for  the 
mission  segments  considered  since  the  aircraft  flights  are  over  short 
distances  and  at  relatively  low  speeds. 

Figures  4 and  5 show  the  notation  for  the  angles,  forces 
and  associated  reference  frames  for  the  aircraft. 
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Maximum 

thrust 


w = 


Angle  of  attack 
Flight  path  angle 
Mass  of  the  aircraft 
Weight  of  the  aircraft 


= Earth  fixed  coordinates 
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g 


Heading  angle 
Roll  angle 


Gravitational 

constant 


(32  ft. /sec.  ) 


Horizontal  Plane 


3.2 


The  Aircraft  Model 


The  resulting  set  of  simplified  equations  for  the  aircraft 

dynamics  are: 


X 

e 

V cos  V cos  <l> 

(3.1) 

Y 

e 

= 

V cos  y sin  <P 

(3.2) 

z 

e 

= 

V sin  y 

(3.3) 

<}> 

= 

^2 

(3.4) 

L sin 

(3.5) 

r 

m V cos  y 

• 

y 

L cos  </»  - W cos  y 

(3.6) 

m V 

V 

= 

+ (L/W  - 1)  (AL1) 

fi  (MT)  cos  a - D-  WsinV 
3 

(3.7) 

(3.8) 

m 

where  ,u 


and 


is  functionally  related  to  the  pilot’s  pitch  input 
(fore-aft  stick  movement) 

is  functionally  related  to  the  pilot's  roll  input 
(side-to-side  stick  movement) 

is  functionally  related  to  the  pilot's  throttle  settings. 
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The  parameter  AL1  is  a constant  taking  on  the  values: 


- K - L > ^ 

MAXG  ’ W 


+ K ^ L / 

MING  ’ W ^ ^ 


where  K is  a scaling  parameter  which  is  used  to  specify  the  aircraft 
pitching  rates  with  respect  to  lift  to  weight  ratio.  In  ADGOMP,  K weis 
an  input  that  was  read  into  the  computer  when  the  real-time  simulation 
was  executed.  Here  K was  assumed  to  be  1.0  for  convenience.  Also, 
the  values  of  MAXG  and  MING  are  artificial  constraints.  Since  there 
is  no  motion  in  the  ADGOMP  simulation,  subjects  can  "pull"  unrealistically 
high  "G"  levels.  This  equation  prevents  subjects'  unreasonable  inputs 
from  "blowing  up"  the  ADGOMP  simulation.  While  MAXG  refers  to  the 
largest  allowable  positive  acceleration,  MING  refers  to  the  largest  allow- 
able negative  acceleration.  Chosen  properly,  MAXG  (+15)  and  MING  (-5) 
prevent  the  execution  of  "impossible"  turns,  dives,  and  climbs.  Even 
so,  the  values  used  in  ADGOMP  are  quite  large,  which  is  one  of  its 
unrealistic  features.  The  values  can  be  readily  changed,  however.  The 
maximum  thrust  is  given  by: 


A,.-.-  (2327  + 0.172  Z - 0.0000031 

MT  e e SS 


+ 11500  - 0.25  Z 


(3.10) 


where 


2 , if  the  afterburner  is  on 


1^  , if  the  afterburner  if  off 


(3.11) 


and  SS  is  the  speed  of  sound  which  is  a function  of  altitude. 


The  ADCOMP  subroutine  uses  an  aircraft  weight  (W)  of 
17,000  lbs  or  a mass  (M)  of  528  slugs.  The  drag  force  (D)  is  a function 
of  the  altitude,  velocity  and  angle  of  attack.  The  lift  force  (L)  is  a 
function  of  angle  of  attack,  altitude,  thrust,  and  velocity.  Appendix  A 
contains  defining  equations  for  the  drag  and  lift  forces. 

The  control  variables  (or  inputs)  for  the  model  are 
fj.  ^ (t)  which  controls  the  rate  of  change  of  the  angle  of  attack  and  is 
proportional  to  longitudinal  stick  position,  (0  which  controls  the  rate 
of  change  of  the  roll  angle  and  is  proportional  to  lateral  stick  position, 
and  (t)  which  is  normalized  percent  throttle.  In  practice  these  inputs 
come  from  the  pilot  or  from  an  autopilot. 

The  dynamic  variables  for  the  model  are; 


«(t) 

= 

Angle  of  attack  (radians) 

V(t) 

= 

Air  speed  of  aircraft  (feet/second) 

x,(t) 

= 

X-position  of  aircraft  with  respect  to 

earth 

(feet) 

V^(t) 

= 

Y-position  of  aircraft  with  respect  to 

earth 

(feet) 

= 

Altitude  of  aircraft  (feet) 

«(t) 

= 

Roll  angle  (radians) 

= 

Heading  angle  (radians) 

7(t) 

= 

Flight  path  angle  (radians) 

differential  equations  if  state  variable  notation  is  used  (Padulo  and 
Arbib,  1974).  This  notation  simplifies  the  description  of  the  optimal 
control  and  CPM  developments. 


The  differential  equations  describing  the  aircraft  dynamics 
can,  in  general,  be  written  in  vector/matrix  form  by  the  state  equation: 

X(t)  = F-  (X)  X (t)  + G (X)  M (t)  (3.12) 

where  (t)  is  the  three-dimensional  control  vector  given  by: 

V ^ (t)' 

/^(t)  = M2<t) 

l^3(t)J  (3.13) 

and  X(t)  is  the  system  state  vector.  Wernli  and  Cook  (1975)  contains  a 
discussion  of  the  "apparent  linearization"  technique  that  rationalizes 
equation  3.12.  The  choice  of  which  of  the  aircraft  dynamic  variables  to 
include  in  the  state  vector  may  vary  depending  on  the  segment  of  the 
mission.  For  example,  in  a cruising  segment  the  X-position  of  the  air- 
craft with  respect  to  earth,  X , should  not  be  included  in  the  state  vector 
X,  since  steady  state  cruising  conditions  do  not  depend  on  Xg.  This  point 
is  discussed  further  in  Section  5.  F(X)  is  the  system  matrix  whose 
elements  are  a function  of  the  state  variables  and  G(X)  is  the  control 
matrix  whose  elements  are  also  a function  of  the  state  variables.  Since 
* F(X)  and  G(X)  are  not  unique  but  change  from  problem  to  problem  (i.e., 

system  A requires  a different  model  than  system  B,  or  mission  phase  1 
for  system  A requires  a different  model  than  phase  II,  etc.),  the  gen- 
f eralized  forms  apply  to  specific  cases  only  when  the  numbers  appropriate 

! to  the  system/problem  at  hand  have  been  defined  and  entered  into  the 

j matrices.  However,  even  in  this  general  form,  the  matrix  equations 

( can  often  be  "solved"  for  the  general  case  so  that  a specific  solution  is 

immediately  available  as  soon  as  the  numeric  values  for  the  matrix  entries 
become  available.  When  this  is  possible,  the  technique  is  indeed  powerful, 
since  for  those  cases  where  the  problem  of  interest  "fits"  one  of  the 
general  cases  already  formulated  and  solved,  then  the  answers  for  the 
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problem  of  interest  are  obtained  relatively  easily.  However,  this  is 
most  often  possible  in  cases  where  the  linearized  models  reasonably 
define  the  steady  state  behavior  of  the  system.  The  theory  of  linear 
systems  is  then  applicable  and  provides  a well  developed  set  of  solution 
techniques  many  of  which  make  use  of  the  matrix  or  linear  algebra. 

For  nonlinear  cases,  the  same  conceptual  scheme  is 
taken  for  setting  up  the  state  variable  equations  in  cannonical  (i.e.,  a 
predefined  "standard,"  and  typically  "simple")  form,  but  the  matrix  ■ 

algebra  does  not  apply,  the  solutions  are  typically  not  known  in  advance, 
and  the  techniques  for  solving  the  equations  may  not  be  readily  available. 

In  these  cases  it  is  often  necessary  to  use  a simulation  and  recursive 

or  iterative  solution  techniques  to  arrive  at  the  definition  of  an  optimal 

control  rule  and  the  associated  optimal  trajectory.  Because  of  these  i 

often  formidable  difficulties,  modelers  often  choose  to  study  a linearized 

model  first  and  develop  nonlinear  representations  only  after  they  have 

exhausted  the  insights  to  be  gained  from  the  simpler  linearized  model. 

The  choice  of  the  F(X)  and  G(X)  matrix  is  not  unique,  but 
can  frequently  be  put  into  the  form  given  by  Equation  3.12.  In  certain 
applications  it  may  be  of  advantage  to  pick  one  form  of  F(X)  over 
another  (Wernli  and  Cook,  1975). 

The  aircraft  state  equation  given  by  Equation  3.12  together 
with  the  performance  index  given  in  Section  2.2  by  Equation  2.1  define  ^ 

an  optimal  control  problem.  The  solution  to  this  optimal  control  problem 
is  the  first  step  in  finding  the  CPM. 

3 • 4 Simplified  State  Equation  for  Constant  Altitude  Cruising 

(Mission  Segment  4) 

■■ 

The  aircraft  equations  described  in  the  previous  sections  can  i 

be  further  simplified  whenever  the  aircraft  is  flown  at  near  constant 
altitude.  Segment  4 provides  a constant  altitude  reference  flight  path, 
and  it  is  assumed  the  aircraft  will  be  near  that  reference  altitude.  As 
a result,  aircraft  coefficients  which  are  functions  of  altitude  can  be 
replaced  by  a constant  value  for  Segment  4 analysis.  The  assumptions 
for  the  simplified  equation  which  are  used  in  Section  5 of  this  report  to 
find  an  optimal  control  for  Segment  4 are  as  follows; 

• The  altitude  Zg  is  approximately  18,000  feet  over 
the  entire  segment 

• The  after-burner  is  off  during  the  entire  segment  t 


Then  for  Zg  = 18,000  feet,  the  following  variables  were 
assigned  specific  values  as  designated  below: 


Air  Temperature  = -5.26°  F 

□ i = 0.87604  (dimensionless) 

Air  Pressure  = 1055.4212  Ibs/sq  ft 

Air  Density  = 1.3539  x 10~^  slugs/ft^ 

Speed  of  Sound  = 1046.9171  ft/sec. 

The  mach  of  the  aircraft  is 

= (9.5519  X 10““^)  V 

The  dynamic  pressure  is 

Q = (6.7695  X lO""^)  V^, 

Dynamic  pressure  affects  the  calculation  of  lift  and  drag  forces  as 
described  in  Appendix  A. 

The  maximum  thrust  (with  after-burner  off)  is 

MT  = 2.1103V  4 3500, 


and  thrust  is 

I 

I 

I 

' T = [2.1103  V 4-  3500.]  . 

o 


The  coefficient  of  lift  is 


where 


I 0 

if 

« > 

0.6 

CL1 

= (1.8 

if 

0.4 

< " < 

0.6 

\ 0.1 

if 

0,4 

> " 

and 


j 0 

if 

" > 

CD 

d 

CL2 

= (-2.0 

if 

0.4 

< O' 

I +2,5 

if 

0.4 

> « 

where  a is  the  angle  of  attack  in  radians.  The  implied  restrictions  are 
a feature  of  the  ADCOMP  subroutine  as  originally  designed.  As  with  the 
choice  of  values  for  MING  and  MAXG,  it  is  not  clear  why  the  designer 
of  ADCOMP  chose  these  exact  limits,  but  it  appears  the  intent  was  to 
preclude  grossly  unrealistic  inputs  to  the  model  even  if  naive  subjects 
inadvertently  induced  such  inputs.  The  coefficient  of  drag  is  given  by 


CD 


0.0327  + 0.1 35«  + 1.6875 


The  drag  then  is  given  by; 


D 


(0. 1367) 


v2 


(0.0327  + 0.1 35«  + 1.6875"  ) 


These  equations  for  drag  (D)  and  the  coefficient  of  drag  (CD)  are  also 
only  applicable  for  cases  where  the  angle  of  attack  ( « ) is  less  than 
0,4,  which  is  an  acceptable  assumption  at  least  for  the  cruise  segment 
of  the  mission. 
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The  component  of  applied  force  normal  to  the  flight  path  is: 

2 

L = [0.13673  (CL1)]  V 

+ [0.13673  (CL2)]  « 

+ [2.1103  V + 3500.]  sin  (a/Hg) 

Assuming,  as  stated  previously,  that  K = 1,  then  the  parameter  AL1 
takes  the  values:* 


AL1 


Using  the  above  approximations  the  aircraft  dynamic  equations, 
become  for  the  cruising  segment: 


1-0.0666,  for 
-0.0400,  for 


L 


17,000 

L 

1 7 , 000 


> 1 


< 1 


X 

e 

— 

V cos 

y cos 

(3.14) 

Y 

e 

- 

V cos 

y sin 

-A 

(3.15) 

Z 

e 

= 

V sin 

y 

(3.16) 

= 

'‘2 

(3.17) 

*The  calculation  of  these  values  is  more  fully  described  in  Appendix  A. 


V 


-4, 


(2.589  X 10  ) CL1 


sin  4> 
cos  y 


—4  sin 

+ (2.589  X 10  ) CL2  ^ a V 

^ ^ cos  y 


r -3  6.6291 

+ I (3.997  X 10  ) + — 


sin  <f>  sin  a 
cos  y 


(3.18) 


r -3,  6.6291 

(3.997  X 10  ) + cos  <f, 


sin  (a  Mg) 


- 32.2  ^ + (2 . 589  x 10  ^)  CL2  cos  ^ “ V 


,-4, 


+ (2.589  X 10  ) CL1  cos  ^ V 


(3.19) 


- AL1  + AL1  [(1.241  X 10  ^)  V + 0. 206]sin(oMg) 


+ [(8.041  X 10~®)  ALl][CL1  (V"")] 


+ [(8.041  X 10  ®)  ALl]  CL2  (aV*")]  (3.20) 


V 


[(3  .997  X 1 0 ^)  V + 6.6293  cos  (®/“g) 


-6  2 

- 32.2  sin  r - (8.466  x 10  ) V 


- (3.495  x 10~®)  aV^  - (4.369  x 10  (3.21) 


Again  the  reader  is  cautioned  that  the  above  equations  apply  for  the 
restricted  values  of  ( a ) that  govern  the  computation  of  values  for 
CL1  and  CL2.  These  equations  are  put  into  state  variable  notation  in 
Section  5. 
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4.0  A CONTINUOUS  PERFORMANCE  MEASURE  FOR  MAN- 

MACHINE  SYSTEMS 

A continuous  performance  measure  (CPM)  for  aircraft  flight 
control  systems  is  developed  in  this  section,  A CPM  is  developed  by  applying 
optimal  control  theory  to  the  manual  control  problem  in  order  to  establish 
the  required  flight  reference  (criteria)  and  significance  of  deviation-from- 
criteria  information.  To  illustrate  the  concepts  and  techniques  used,  an 
example  problem  is  presented. 


4. 1 Performance  Measurement  Requirements 

A motivation  and  rationale  for  developing  a CPM  is  presented 
in  the  introduction.  The  desired  properties  of  the  CPM  are  summarized 
as  follows; 

1 . The  measure  should  allow  comparison  of  present 
performance  with  respect  to  preferred  performance 
where  the  preferred  performance  is  defined  by  the 
system's  motion  in  state  space  (trajectories)  under 
the  optimal  control  law. 

2.  The  optimum  control  against  which  performance  is 
being  evaluated  should  be  determined  in  terms  of  a 
system  performance  (cost)  index  which  in  turn  is 
selected  by  examination  of  the  associated  optimal 
state  space  trajectories . 

3.  The  measure  should  allow  instantaneous  (state  related) 
performance  measurement,  as  well  as,  average  perfor- 
mance measurement  over  an  arbitrary  time  interval 
within  the  task. 

4.  The  measure  should  allow  determination  of  critical 
regions  in  the  system  state  space.  Critical  regions 
refer  to  regions  that  are  particularly  sensitive  to 
accurate  operator  control . The  performance  measure- 
ment must  allow  both  theoretical  determination  and 
experimental  determination  of  high  cost  sensitivity 
regions  in  state  space. 

The  first  step  in  developing  the  CPM  for  manual  control 
systems  is  to  formulate  mathematically  the  objective  of  the  control  task 
as  a performance  index  J.  The  performance  index  J is  a summary 
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measure  for  the  task.  Examples  of  some  types  of  J where  this  might 
be  appropriate  include  cases  where  performance  is  defined  in  terms 
of  a penalty  or  "cost"  function:  minimize  the  time  to  complete  the 

task,  minimize  the  fuel  expended,  minimize  the  error,  etc. 


The  differential  equations  describing  the  system  to  be  con- 
trolled together  with  J constitute  an  optimal  control  problem.  If  a 
solution  to  the  optimal  control  problem  exists  and  can  be  found  in  the 
form  of  the  optimal  feedback  control  law,  then  the  control  to  be  applied 
to  the  system  in  any  state  is  determined  such  that  J will  have  a minimum 
value.  For  example,  if  J represents  the  time  to  complete  the  control 
task,  then  the  solution  to  the  related  optimal  control  problem  will  yield 
a feedback  control  law  which  results  in  the  task  being  completed  in  the 
minimum  \time  possible. 

Any  non-optimal  control  applied  to  the  system  by  the  operator 
will  result  in  a larger  value  for  J.  The  CPM  developed  in  this  section 
is  based  on  the  instantaneous  effect  of  a non-optimal  control  applied  to 
the  system  at  any  time  during  the  task.  This  is  done  by  comparing  the 
effect  of  the  non-optimal  control  on  J as  opposed  to  the  effect  if  an 
optimal  control  had  been  applied  to  the  system.  By  doing  this,  a CPM 
is  developed  which  gives  an  instantaneous  measure  of  the  operator’s 
performance  as  compared  with  optimal  or  "best  possible"  performance. 

Again  the  reader  is  cautioned  that  "optimum"  is  defined 
(or  influenced)  by  the  terms  one  places  in  the  performance  index  and  the 
weights  used  in  the  scoring  matrices.  While  these  may  reflect  objective 
quantities  (fuel,  time,  etc.)  or  the  engineer's  judgment  (large  penalty 
weights  placed  on  altitudes  "close  to  the  ground"),  it  was  also  proposed 
that  these  could  be  subjective  weights  if  one  wished,  thereby  reflecting 
a single  pilot's  a priori  goals,  or  a training  instructor's  criteria,  or  an 
operating  command's  policy.  Consequently,  the  comparison  the  CPM 
makes  to  the  "best  possible"  performance  is  always  relative  to  the  nature 
of  the  goals  one  explicitly  puts  into  the  performance  index.  The  issue 
of  which  goals  are  in  some  sense  "best"  is  yet  another  issue,  and  one 
that  is  beyond  the  scope  of  this  discussion.  Here  it  is  assumed  the  goals 
have  been  appropriately  chosen  and  accurately  reflected  in  the  performance 
index. 


If  the  operator  is  using  the  optimal  control,  then  the  value 
of  the  CPM  is  zero.  If  the  operator  uses  non-optimal  control,  the  CPM 
is  positive  and  its  value  is  equal  to  the  significance  of  the  control  error. 
This  sensitivity  property  of  the  CPM  is  demonstrated  in  the  following 
sections . 
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The  system  to  be  controlled  is  described  by  a vector/matrix 


differential  equation  of  the  general  form: 

X(t)  = f [X(t),  U(t)]  (4.1) 

where  X(t)  is  the  vector  of  state  variables,  U(t)  is  the  vector  of  control 
variables,  and  f is  some  function  of  X and  U.  It  is  assumed  that  the 
objectives  of  a segment  of  the  mission  can  be  analytically  expressed  as 
the  minimization  of  a scalar  performance  index  of  the  general  form: 


J [X(t),  U(t)]  = r E[X(t),  U(t)]dt 
t •' 


(4.2) 


where  t is  the  initial  time  and  t^  is  the  final  time  of  the  problem. 
E is  a positive  definite  function,  that  is,  E [x(t),  U(t)3  ^ 0 for  all 
1 values  of  X / 0 and  U 0.  Examples  of  positive  definite  functions 

' that  arisp  in  some  typical  control  problems  are: 

1 . E is  a quadratic  function  of  X and  L),  that  is 


E(X,U)  = x"^(t)  Q X(t)  + U^(t)  R U(t)  (4.3)  , 

! 

where  R is  a positive  definite  matrix  and  Q is 
a non-negative  definite  matrix* 

2.  minimum  time  problems,  where 

i 

E(X,U)  = 1 (4.4)  j 


*The  differential , integral,  and  matrix  calculus  are  used  in  the 
remainder  of  this  chapter  and  the  reader  is  assumed  to  have  a 
reading  knowledge  of  the  notation  (see  Padulo  and  Arbib  (1975), 
Sage  (1968),  Bryson  and  Ho  (1976),  Athans  and  Falb  (1966)  or 
Anderson  and  Moore  (1971)  for  engineering  application  and  Pipes 
(1963),  Bellman  (1970)  or  Gantmacher  (1959)  for  mathematical 
development). 
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The  related  optimal  control  problem  is  to  find  a feedback 
control  law  which  transfers  the  system  of  Equation  4.1  from  any  initial 
state  to  a given  terminal  condition  and  which  minimizes  the  performance 
index  of  Equation  4.2.  Assuming  a solution  exists  and  can  be  found 
analytically,  the  optimal  feedback  control  law  can  be  written  in  functional 
form  as: 

U*(t)  = /3[X(t),  t]  (4.5) 


Equation  4.5  specifies  the  optimal  control  to  be  applied  for  every  state 
of  the  system.  That  is,  equation  4.5  asserts  that  the  optimal  control 
(U*(t)  ) is  some  as  yet  unspecified  but  derivable  function  (/3),  and  the 
only  required  inputs  or  arguments  to  that  function  are  the  states  of  the 
system  at  time  (t),  the  X(t),  and  the  actual  or  current  time  (t).  Using 
this  optimal  control  will  result  in  the  minimum  value  for  J,  which  will 
be  denoted  as  J*.  This  is,  by  definition,  the  best  performance  possible 
for  this  segment  of  the  mission. 

4.3  "Cost-to-Go"  Function 


r 


Using  the  optimal  feedback  control  law,  we  can  replace 
U(t)  with  U*(t)  to  define  the  optimal  cost  to  go  (S*(X(ti)>  U*(t))),  but 
by  Equation  4.5,  we  can  also  replace  U*(t)  with  p [X(t),  t^,  so 
Equation  4.7  finally  becomes 


] ^ A 


X(t),  /ff(X(t},  t) 


(4.8) 


Notice  that  the  optimal  "cost-to-go"  is  the  value  of  the 
integral  when  the  optimal  feedback  control  law  is  the  control  the 
operator  decides  to  use  from  time  t^  to  tf  and,  therefore,  g*  depends 
only  on  the  state.  It  follows  from  Equation  4.8  that  the  "cost-to-go" 
evaluated  at  t^  = tf  is 


0*  [x(y]  = 0 


and  if  evaluated  at  t^  = then 


(4.9) 


^[X(to)3  = J*(tp. 


(4.10) 


Note  also  that  from  Equation  4.7 


t = t. 


-E  [X(t^),  U(t^)] 


(4.11) 


4.4  Continuous  Performance  Measure 

Consider  the  effect  of  two  different  control  laws  on  the 
performance  index  by  comparing  trajectories  and  cost  values  for  two 
solutions  with  different  control  laws  but  the  same  initial  conditions. 
Assume  the  first  control  law  used  is  the  optimal  feedback  control, 
while  the  second  control  law  is  such  that  between  time  to  and  t^  the 
optimal  control  U*(t)  is  applied,  but  between  time  t^  and  tf  a non- 
optimal  control  U^(t)  is  applied.  This  is  shown  in  Figure  6.  The 
value  of  the  performance  index  using  the  first  control,  i.e.,  the 
optimal  control  U*  is 


' ~ .,v. , 


Subtracting  Equation  4.13  from  Equation  4.12  gives  the  cost  difference 
between  the  use  of  an  optimal  and  a non-optimal  control  law  over  the 
time  interval  [t^  , t^],  as 


I 


■I 

\ 


I 

I 


|X(t^),  U^(t)J 


The  cost  difference  a J depends  on  the  time  t-| , that  is,  when  the  non- 
optimal  control  was  first  applied,  but  indirectly  through  the  state 
and  control  variables . 

Consider  the  cost  difference  A J if  the  same  control  Ui 
is  applied  at  some  late  time  (t^  + At),  where  At  is  a very  small  positive 
time  increment.  Expand  the  cost  difference  AJ  [X(t^  + At),  U-|  (t)] 
in  a Taylor's  series  expansion  in  At  about  the  time  ti  . This  is  given 
by: 


The  last  term  on  the  righthand  side  of  Equation  4.15  represents  higher 
order  terms  (H.O.T.)  that  depend  on  (At^)  or  larger  powers.  Rearranging 


Equation  2.15  and  dividing  by  At,  the  incremental  cost  difference  is 
given  by: 


AJ  [x(ti  + At),  Ui(t)]  - AJ  |^X(ti),  U,(t)] 


H.O.T.  (At^^) 


U(ti),  X(ti) 


(4.16) 


Equation  4.16  represents  the  incremental  cost  difference  between  the 
use  of  the  optimal  control  U*  and  the  non-optimal  control  over  the 
time  interval  t^  to  (t-j  + At).  In  other  words,  the  incremental  cost 
difference  is  the  increase  in  the  value  of  the  performance  index  due  to 
the  use  of  the  non-optimal  control  Ui  during  the  time  interval  t^  to 
(ti  + At). 


time  t-|)  as: 


Define  the  Continuous  Performance  Measure  (CPM  at 


♦ [xd,,,  U,(t)]  . Urn  ^4x(tl  * ^t),  Udt).: 


At— • o 


(4.17) 


Making  ise  of  Equations  4.11,  4.  |4,  and  4.16  in  Equation  4.17,  the 
CPM  evaluated  at  time  t^  using  control  Ui(ti)  is  given  by: 


^[x(t,),  u^(t^)  = 


d<^*[X(t). 

dt 


U^(t^),  X(t^) 


^ d^*[x(t)] 

U,(t,),  X(t,)  U ft  ),  X(t  ) 


1'  1"’  -v-l- 


r r’  ' r 


(4.18) 


I 


The  continuous  performance  measure  <t>  of  Equation  4.18 
can  be  interpreted  as  the  instantaneous  increase  in  the  value  of  the 
performance  index  due  to  the  use  of  the  non— optimal  control  at 
time  ti  . If  one  now  considers  any  time  t between  tQ  and  tf,  i.e., 
tQ<t<tf,  and  any  admissible  control  U(t),  the  CPM  of  Equation  4.18 
generalizes  to 

1 d<^*[x(t)]  1 

^ 1 U(t),  X(t) 

+ Ejx(t),  U(t)j  (4.19) 

Equation  4.19  can  be  evaluated  at  each  point  in  time  to 
yield  a continuous  metric  of  performance  which  only  depends  on  the 
present  state  and  present  value  of  control . 

4.5  Properties  of  CPM 

In  this  section,  several  properties  of  the  CPM  are  presented. 

1.  The  CPM,  [X(t),  U(t)3  is  zero  when  evaluated  using 
the  optimal  control  law  of  Equation  4.5  i.e., 

<#>|x(t),  U*(t)j  = 0,  for  t^<t<t^  (4.20) 

2.  Using  the  optimal  feedback  control  law.  Equation 
4.19  is 

+ Efx(t),  U*(t)l  = 0 (4.21) 

U*,X 

I 

I 

However,  if  the  "cost-to-go"  in  Equation  4.21  is 
only  a function  of  the  state  variables,  then 


I 


r 


1 

1 


I 


de*[x(t)1 

dt 


u*,x 


= fjx(t),  /3(X(t))j  (4.22) 

The  last  substitution  is  based  upon  Equations  4.  1 
and  4.5.  Using  Equation  4.22  in  Equation  4.21, 
yields  the  partial  differential  equation  whose 
solution  is  the  optimal  "cost-to-go"  function  as: 


f [x(t),  /?  (X(t))J  + E[x(t),  /3(X(t))j  - 0 (4.23) 

where  p [X(t)]  is  the  optimal  feedback  control  law. 

3.  From  the  definition  of  9 and  the  assumption  that 
e[x,  u]  >0,  this  implies 

0*[X(t)]  > 0. 

4.  Property  1 above  implies  that 

U(t)]  > 0 if  U U*. 

5.  The  integral  of  the  CPM  over  the  problem  time 
interval,  [tQ,  t|r3  is  given  by 

[^X(t),  U(t)Jdt  = J(U)  - J*(U*) 
t 

o 

which  is  the  difference  between  the  performance 
index  evaluated  using  the  operators  control  and  that 
obtained  using  the  optimal  control  law. 
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[f  the  performance  index  reflects  a model  of  the  operator's 
goal  aspirations,  then  J(U)  - J*(U*)  implies  the  degree  of  dissatisfaction 
which  may  be  experienced  when  performance  falls  short  of  the  operator's 
objectives.  If  instead  the  performance  index  is  based  upon  an  instruc- 
tor's criteria,  then  J(U)  - J*(U*)  reflects  the  operator's  earned 
score  for  less  than  perfect  performance.  If  some  "ideal"  resource 
expenditure  is  reflected  in  the  performance  index,  then  J(U)  - J*(U*) 
reflects  the  wastefulness  of  non-optimal  or  sub-optimal  control  rules 
or  policies  and  the  behavior  guided  by  these.  So  again,  a specific 
interpretation  depends  upon  the  a priori  specification  of  the  objectives 
captured  in  the  performance  index. 

4.6  Application  of  the  Continuous  Performance  Measure 

Generation,  use,  and  interpretation  of  the  continuous 
performance  measure  <f>  (X,U)  involves  the  following  steps  (the  system 
equation,  performance  index  and  control  constants  are  assumed  to  be 
given): 


1 . Obtain  an  analytic  formulation  of  the  optimal  feedback 
control  function  U*  [X(t)  ] and  the  "cost-to-go" 
function 

2.  Form  the  performance  measure  <f>  (X(t),  U(t)) 

^ dg*[x(^  I ^ E[x(t),  U(t)l 

I U(t),  X(t) 

where  U is  the  operator's  present  control  action  at 
each  instant  of  time  (t). 

3.  Make  the  following  observations; 

a.  <l>  (X(t),  U(t))  = 0 if  the  operator  is  using 

optimal  control, 

b.  <!>  (X(t),  U(t))  > 0 if  [u(X(t))]  5^  U*[X(t)] 

(if  4>  (X(t),  U(t))  = 0 for  U 7^  U*,  then 

control  sensitivity  to  cost  is  zero). 
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in  previous  sections.  In  this  section,  the  CPM  is  found  for  the  infinite- 
time Linear  Regulator  Problem. 

4.7.1  CPM  For  Linear  Regulator  Problem 


Consider  the  standard  infinite-time  linear  regulator 
problem  (Sage,  1968,  Bryson  and  Ho,  1967,  Athans  and  Falb,  1966  and 
Anderson  and  Moore,  1971).  Given  the  state  equation  as; 

X(t)  = A X(t)  + B U(t)  (4.24) 


with  arbitrary  initial  condition  X(0)  = Xq  where  A and  B are  constant 
matrices,  X(t)  is  the  state  vector,  and  U(t)  is  the  control  vector.  The 
performance  index  is  given  by: 

00 

J = '4  j j^X^(t)  Q X(t)  + U^(t)  R U(t)j  dt  (4.25) 

o 

where  Q and  R are  positive  definite  symmetric  constant  matrices. 

The  optimal  control  problem  is  to  find  the  feedback  control 
law  U*  = U(X)  which  transfers  the  system  given  by  Equation  4.24  from 
any  arbitrary  initial  state  Xq  to  the  destination,  while  minimizing  the 
performance  index  of  Equation  4.25. 

The  well-known  solution  to  this  problem  (Sage,  1968,  Bryson 
and  Ho,  1967,  Athans  and  Falb,  1966  and  Anderson  and  Moore,  1971)  is  the 
optimal  feedback  control  law  given  by; 

U*(t)  = -R“^  K X(t)  (4.26) 


where  K is  the  positive  definite  symmetric  constant  matrix  which  is 
the  solution  of  the  matrix  equation: 


KBR 


-1 


B^  K - KA  - A^K  - Q = 


(4,27) 


The  minimum  value  of  the  performance  index  is  given  by; 
j*  = !^  x"^  (0)  K X (0) 


(4.28) 
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4.7.1  . 1 


Cost-to-Go"  Function: 


9*  [X(t)] 


The  "cost-to-go"  function  must  satisfy  tquation  4.21  along 
an  optimal  trajectory.  For  this  example: 

E I^X(t),  U(t)J  = j^x''^(t)  Q X(t)  + U^(t)  R U(t)j  dt 


but  by  Equation  4.26: 


U*(t)  = R ’ b"'^  X(t) 


so  E[X(t),  U*(t^  becomes: 


’4  |x'’^(t)  Q X(t)  + 


^-R  ^ X(t)^^  R ^-R  ’ X(t)^  j 


which  may  be  simplified,  using  the  matrix  calculus  (Gantmacher  1959)  to  the 
expression  ’ 

E|x(t),  U*(t)j  = 1^  x"^(t)  I^Q  + K B R~'  B^  k]  X(t)  (4.29) 

Substituting  eq.  4,26  in  eq.  4,24, 


de*  j 
dt 


U*,X 


9(?*[x(t)]  y • 


(4.30) 


So  now  the  differential  equation  from  which  the  optimal  "cost-to-go" 
function  derives  (as  defined  by  eq.  4.23)  can  be  expressed  by  combining 
equations  4.29  and  4.30, 

+ 3^  xT(t)  [q  + K B R'l  bT  K]x(t)  (4.31) 
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Along  the  optimal  trajectory,  this  expression  is  equal  to  zero  (which 
implies  that  either  both  4.29  and  4.30  are  zero  or  that  one  is  the 
negative  of  the  other,  i.e.,  they  balance  out  or  null  one  another). 
Further,  by  definition  of  ®*,  we  know  that  at  x(t)  = 0 g*(X(t))  = O. 

This  is  a boundary  condition  imposed  upon  eq.  4.31  . 

The  "cost-to-go"  function  which  is  the  solution  to 
Equation  4.31  is 


8*  [x(t)]  = x"’’(t)  K X(t) 


(4.32) 


where  K is  the  positive  definite  symmetric  constant  matrix  which  is 
the  solution  of  Equation  4.27.  Since  K is  positive  definite,  then 
8*  [X(t)]  > 0 for  any  X(t)  ^ 0;  and 

8*  [x(0)]  = 3^  x"'’(0)  K X (0)  = J* 

and 


4. 7. 1.2  Continuous  Performance  Measure  0 [X(t),  U(t)] 

The  Continuous  Performance  Measure  (CPM)  evaluated 
at  the  present  state  and  control  is  given  by  Equation  4.19  and  is 
repeated  here  for  convenience  as  Equation  4.33 


+ 


[x(t),  U(t)] 


(4.33) 


Borrowing  from  eq.  4.29  and  4.30,  4.33  may  be  written 
^[x(t),  U(t)]  = ^ [a  - B r'^  B k]  X(t) 

+ '4  x\t)  |q  + K B R"’b  kJ  X(t) 

which  with  approprite  manipulation  using  the  matrix  calculus  becomes 

<^[x(t),  U(t)]  = 3^  x"'^(t)  I^K  B r"^  B^  k]  X(t) 

+ x"^(t)  K B U(t) 

+ 3^  U^t)  R U(t)  • (4.34) 

Note  that  if  the  optimal  control  U*  given  by  Equation  4.26  is  used,  then 
fl[X(t),  U*(t)]  = 0.  That  is,  the  CPM  evaluated  using  the  optimal 

control  is  zero. 

Assume  that  the  operator's  present  control  action,  U(t), 
can  be  written  as  some  deviation  from  the  optimal;  that  is, 

U(t)  = U*(t)  + e(t)  (4.35) 

where  U*(t)  is  the  optimal  feedback  control  given  by  Equation  4.26  and 
e(t)  is  the  control  error.  Note  that  the  control  error  is  the  difference 
between  the  operator's  control  action  at  the  present  time  and  the  optimal 
control  action  for  the  present  state. 


Using  Equation  4.35  in  Equation  4.34  the  CPM  in  terms  of 
the  control  error  is  given  by; 


Since  it  was  assumed  that  R is  chosen  as  a positive  definite  matrix, 
this  implies  that  </.  [e(t)]  > 0 for  e(t)  if-  0 and  <^[e(t)]  = 0 for  e(t)  = 0. 

Hence  the  CPM  is  a positive  definite  function. 
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4. 7. 1.3  Sensitivity  of  Continuous  Performance  Measure 

The  sensitivity  of  the  CPM  to  small  variations  in  the 
operator's  control  action  can  be  found  by  taking  the  partial  derivative 
of  Equation  4.34  with  respect  to  U(t),  which  for  this  example  is: 

^</{X(t),  U(t)|  3,  e'f  K X(t)  4 R U(t) 

SU(t)  ^ 

Note  that  the  sensitivity  of  the  CPM  to  the  control  is  proportional  to 
both  the  present  state  and  the  present  control  action  for  this  linear- 
regulator  example.  This  implies  that  non-optimal  operator  action  is 
more  serious  in  some  states  that  in  others. 

The  sensitivity  of  the  CPM  to  small  variations  in  the 
control  error  e(t)  can  be  found  for  this  example  by  taking  the  partial 
derivative  of  Equation  4.36  with  respect  to  e(t),  which  is: 


^e(t) 


R e(t) 


Note  that  for  this  example  the  sensitivity  of  the  CPM  is  directly 
proportional  to  the  present  control  error  weighted  by  the  matrix  R 
regardless  of  the  present  state.  This  implies  that  the  changes  in 
the  performance  index  will  reflect  a cost  weighted  penalty  for 
inappropriate  action  but  will  not  again  penalize  him  for  being  in  some 
undesirable  state.  So  long  as  he  makes  the  best  of  a bad  situation, 
he  can  keep  the  performance  index  "down,"  i.e.,  by  minimizing  his 
own  errors  (by  responding  in  a manner  appropriate  to  the  specified 
and  quantitative  objectives)  he  can  effectively  produce  a minimal 
performance  index  as  he  was  instructed  or  set  out  to  do. 
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5.0 


APPLICATION  OF  CPM  TO  A CRUISING  SEGMENT  OF 
THE  MISSION 


In  this  section,  the  theoretical  results  and  methodology 
of  tHfe  proceeding  three  sections  are  used  to  find  a continuous  perfor- 
mance measure  for  a cruise  segment  (Segment  4)  of  the  aircraft 
mission. 


First,  the  optimal  control  problem  is  formulated  for  the 
cruising  problem.  This  involves  the  formulation  of  the  state  equations 
and  performance  index.  Next,  an  approximate  solution  of  the  optimal 
control  problem  is  given  for  the  cruising  segment  (Segment  4)  of  the 
aircraft  mission.  Based  on  the  approximate  optimal  control  law,  the 
CPM  for  the  cruising  segment  is  derived.  Preliminary  computational 
results  are  presented  for  the  CPM  when  a non-optimal  control  policy 
(an  auto-pilot)  is  used  to  fly  the  aircraft  in  Segment  4. 

5 . 1 Cruise  Problem  Formulation  for  Segment  4 


The  formulation  of  an  optimal  control  problem  for  the 
cruising  segment  of  the  aircraft  mission  is  developed  in  this  section. 

5.1.1  Selection  of  a Performance  Index 

A generalized  performance  index,  common  to  many  segments 
of  a mission,  was  described  in  Section  2,  and  is  given  by: 

J = [w  - ^<v] 

+ y 'j[Xp(0  - X(t)]^Q  [X|^(t)  - X(t)] 

+ [u^(t)  - U(t)]"^R  [up,(t)  - U(t)] 

+ [x(t)]^  w X(t)|  dt  (5.1) 

where  t©  is  the  initial  time,  Xp(t)  and  Up(t)  are  possible  reference 
state  and  control  functions,  t^  is  the  final  time,  X is  the  vector  of 
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state  variables  of  the  system,  U is  a vector  of  control  variables  of  the 
system,  and  S,  W,  Q,  and  R are  weighting  matrices.  The  generalized 
performance  index  is  made  up  of  a term  that  penalizes  state  variable 
errors,  excessive  control,  and  large  rates  of  change  of  state  variables. 

For  a general  cruising  mission  segment,  the  assumed 
objective  is  to  maintain  constant  heading,  altitude,  and  velocity  over 
a given  distance  with  small  changes  in  the  control  and  state  variables 
that  may  be  required  for  any  error  correction.  The  final  time  (t^) 
and  the  error  in  the  terminal  state  (X(tf)R  - X(tf))  is  assumed  not  to 
be  of  primary  importance.  The  problem  is  terminated  when  the  air- 
craft has  travelled  a specified  distance  over  the  earth.  Therefore, 
Equation  5.1  is  adapted  to  a cruising  problem  by  not  penalizing  the 
error  in  the  final  state,  i.e.,  let  the  weighting  matrix  S be  all  zero 
elements;  and  by  letting  the  final  time  tf  be  undefined,  that  is,  tf  = oo. 
In  order  to  simplify  the  development,  the  rate  of  change  of  the  state 
variables  are  not  penalized  in  the  performance  index,  i.e.,  the 
weighting  matrix  W has  all  zero  elements.  The  objective  for  Segment 
4 of  the  mission  is  to  cruise  at  18,000  feet  altitude  at  a speed  of 
708.87  feet/sec.  (420  knots).  The  direction  to  target  is  selected  as 
due  East,  so  that  the  aircraft  should  travel  along  the  Xe  - axis.  The 
corresponding  reference  aircraft  heading  is  taken  as  zero  radians, 

(f  = 0).  The  segment  flight  problem  is  terminated  when  the  aircraft 
has  traveled  East  for  fifty  nautical  miles,  (Xg  = 303,805.75  feet 
(50  nm.)). 


The  desired  steady-state  flight  condition  for  Segment  4 
of  the  mission  (straight  and  level  flight  due  east)  is  the  reference 
trajectory.  When  the  aircraft  flys  along  the  reference  trajectory  all 
variables  are  constant  except  for  Xg  which  is  changing  at  a rate  of 
708.87  feet/sec.  Figure  7 shows  this  reference  trajectory  in  a vertical 
plane  indicating  altitude  versus  X-position  of  the  aircraft  with  respect 
to  earth.  Also  shown  are  several  preferred  (optimal)  trajectories  for 
several  non-reference  initial  conditions. 

Choose  as  the  vector  of  state  variables  for  this  problem 


the  7-dimensional  vector  X , 

defined 

by 

a 

(t)“ 

4> 

(t) 

f 

(t) 

X(t)  = 

y 

rr 

Vw/ 

V 

(t) 

Ye 

(t)  1 

_2e 

(t)J 

X(t) 


(5.2) 


FIGURE  7 X-POSITION  OF  AIRCRAFT  WITH  RESPECT  TO  EARTH 


Notice  that  the  aircraft  variable  has  not  been  included  in  the  state 
vector  X.  This  is  because  in  Segment  4,  the  X-position  of  the  aii 
craft  with  respect  to  the  earth  does  not  need  to  be  used  to  generate 
a feedback  control  to  maintain  the  reference  trajectory.  This  will 
become  clear  from  an  inspection  of  the  aircraft  dynamic  equation  in 
Section  3,4. 


given  by 


The  reference  state  vector  for  Segment  4 is  constant  and 


0.0594  radians 
0.0 
0.0 

0.0  I (5.3) 

708.876  ft. /sec. 

0.0 

18000.0  ft. 


These  are  the  values  of  the  state  variables  along  the  reference  trajectory 
in  a steady-state  flight  condition.  In  the  desired  steady-state  flight 
condition  the  rate  of  change  of  the  state  variables  is  zero. 


= 0 


The  aircraft  control  variables  that  maintain  the  reference  state  vector 
Xr,  provided  the  aircraft  is  in  the  reference  state,  is  given  by  the 
constant  3-dimensional  reference  control  vector 


•.  .,1 


^R 


-0.0702- 



u 

0.0 

2 

-^3- 

-0.541  - 

(5.4) 


Equations  5.3  and  5.4  respectively,  the  performance  index  for  the 
cruising  problem  of  Segment  4 is  given  by  Equation  5.5. 


00 

J = '4  J |(Xr  - X(t)/  Q (Xr  - X(t)) 
0 

+ (U^  - U(t))'^R  (U^  - U(t))  f dt 


(5.5) 


The  selection  of  the  weighting  matrices  Q and  R are  discussed  in 
Section  5.4.3. 


The  performance  index  for  cruising  (segment  4)  given  by 
Equation  5.5  tends  to  limit  excessive  control  element  displacements  and 
insures  that  the  reference  trajectory  is  an  optimal  trajectory.  The  1/2 
term  in  front  of  the  integral  is  merely  a scaling  factor  for  convenience. 

5.1.2  State  Variable  Formulation  of  Aircraft  Equation  for 

Segment  4 of  the  Mission 

The  simplified  set  of  equations  (3.14  thru  3.21)  that  rep- 
resent the  model  of  aircraft  dynamics  for  the  cruising  segment  of  the 
mission  (Segment  4)  are  given  in  Section  3.4.  The  model  of  aircraft 
dynamics  is  put  into  state  variable  form  as: 


X 

e 


V cos  y cos  ^ 


(5.6) 


and  the  vector/matrix  differential  equation 


X(t) 


F (X)  X(t)  + G(x)  U(t) 


(5.7) 


where  X(t)  is  the  7-dimensional  state  vector  defined  by  Equation  5.2, 
and  U(t)  is  the  3-dimensional  control  vector  defined  by 


U(t) 


U^(t) 

Ug(t) 


(5.8) 
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The  matrix  F(x)  is  the  (7  by  7)  dimensioned  system  matrix  whose 
elements  are  a function  of  the  state  vector,  where 


F(X)  = 


f (x) 

1 r 


f (X) 

3r  ^ 


0 0 f (x)  0 f (X) 

15^  ^ 17^  ; 


0 0 0 


0 0 


O 0 


0 0 


O 0 


^47^")  ; 

^57(")  i 


0 0 


0 0 


and  G(X)  is  the  (7  by  3)  - dimensioned  control  matrix  whose  elements 
are  a function  of  the  state  vector,  where: 


G(X)  = 


943<’'^  ; 

S53^’'>  I 


^17 

-AL1/Z 
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cos  y 
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2e 

^65 
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^75 
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sin  y 
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(ALl)  [(1.241  X 10”“^)  V + 0.2059]  sin  « 
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^33 
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CO 

= 

r -3  6.6288  n 

(3.997  X 10  ) + — — J sin  n cos  <t> 

I 

g = [(3.997  X 10"^)  V + 6.6288]  cos  « 


Figure  8 shows  a block  diagram  oF  the  structure  of  the 
aircraft  model  used  for  Segment  4.  Note  that  in  the  steady  state  flight 
condition,  that  is  on  the  reference  trajectory.  Equation  5.7  becomes: 


5.2  Optimal  Control  Problem  For  Cruising 

5.2.1  Statement  of  the  Problem 

The  optimal  control  problem  statement  for  Segment  4 
of  the  mission  is  as  follows;  Given: 

1 , the  state  equation 

X(t)  = F(X)  X(t)  + G(X)  U(t)  (5.10) 

described  in  Section  5.1.2,  with  an  arbitrary  initial  state  vector  X(0), 

2,  the  reference  state  vector  of  Equation  5.3  and  the 
reference  control  vector  of  Equation  5.4  such  that 

X^  = F(Xr)  Xr  + G(X^)  = 0 (5.11) 

is  satisfied  along  the  reference  trajectory,  and 

3,  the  performance  index  of  Equation  5.5,  repeated 
for  convenience, 

00 

J = Ji  f [(X  -X(t))^  Q (Xr  - X)  (t) 

*b 

+ (U^  - U(t))'^  R (U^  - U(t))]  dt  (5.12) 

where  it  is  assumed  that  R is  a (3  x 3)  positive  definite  symmetric 
matrix  of  constants  and  Q is  an  (7  x 7)  symmetric  positive  definite 
matrix  of  constants  whose  values  are  chosen  to  yield  optimal  trajec- 
tories which  are  the  preferred  aircraft  trajectories,  the  problem  is 
to  find  the  feedback  control  law,  U as  a function  of  the  state  variables, 
such  that  any  initial  state  X(0)  is  transferred  to  the  reference  state 
Xr  and  the  performance  index,  J,  of  Equation  5.12  is  minimized. 

Note  that  the  optimization  problem  defined  by  Equation 
5.10  and  5.12  is  similar  to  the  standard  linear  tracking  problem  of 


i 

s 


optimal  control  theory  (Bryson  and  Ho,  1967  or  Athans  and  Falb,  1966). 
The  problem  formulated  here  differs  because  the  F and  G matrices 
elements  are  functions  of  the  state  variables.  This  is  also  analogous 
to  the  classical  compensatory  tracking  task  used  in  laboratory  studies 
of  manual  control,  where  F and  G constitute  the  so  called  "plant 
dynamics."  Here  the  plant  dynamics  are  non-linear  and  time  varying, 
again  because  of  F and  G being  functions  of  the  state  variables. 

5.2.2  Approach  to  a Solution 


There  are  several  different  approaches  which  can  be  taken 
to  solve  this  non-linear  optimization  problem.  Applying  Pontryagin's 
maximum  principle  will  yield  a set  of  necessary  conditions  for  the 
solution  to  the  optimization  problem.  However,  these  necessary  con- 
ditions would  be  in  the  form  of  a set  of  non-linear  differential  equations 
which  must  be  solved  for  given  boundary  conditions.  Although  this 
approach  is  feasible  for  finding  open— loop  control  (control  as  a function 
of  time),  it  is  not  practical  for  developing  feedback  control  laws  (control 
as  a function  of  state). 


A second  approach  is  to  use  the  method  of  continuous 
dynamic  programming  developed  by  Bellman  which  yields  a sufficient 
condition  for  the  optimum.  This  condition  is  in  the  form  of  a partial 
differential  equation  known  as  the  Hamilton— Jacobi-Bellman  equation. 

In  general,  the  Hamilton-Jacobi-Bellman  equation  cannot  be  easily 
solved;  however  when  it  can,  the  control  is  determined  as  a function 
of  the  state  variables,  i.e.,  feedback  control.  A detailed  discussion 
and  derivation  of  Pontryagin's  maximum  principle  and  the  Hamilton- 
Jacobi-Bellman  equation  can  be  found  in  Sage  (1968),  Bryson  and  Ho 
(1967),  Athans  and  Falb  (1966)  and  Anderson  and  Moore  (1971). 


The  optimal  control  problem  for  the  cruising  segment 
can  be  approximately  solved  using  the  Hamilton-Jacobi-Bellman  equation. 
However,  the  standard  approach  is  modified  so  that  this  partial  dif- 
ferential equation  need  not  be  solved  directly.  This  modified  approach 
has  been  successfully  used  on  other  types  of  optimal  control  problems 
(Zeskind  and  Vimolranich,  1973). 


5.2.3 


Hamilton-Jacobi-Bellman  Equation  For  Optimal  Cruising 
Problem 


where  H(X, 


Equation  5.13  is  the  Hamilton-Jacobi-Bellman  equation, 
U,  . t)  is  the  Hamiltonian. 


-min  H(X, 


U, 


^J 

dX  ’ 


t) 


(5.13) 
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It  states  that  the  partial  derivative  of  the  optimal  performance  index 
with  respect  to  time  is  equal  to  the  negative  of  the  Hamiltonian 
evaluated  along  the  optimal  trajectory,  that  is,  evaluated  using  the 
minimizing  value  of  U.  The  Hamiltonian  for  the  problem  considered 
here  is 


H = ^ [Xr  - Q [Xp  - X(t)] 


+ (Up,  - U(t)  )R  (U^  - U(t)) 


+ (~|^)  [PCX)  X(t)  + G(X)  U(t)] 


Minimizing  the  Hamiltonian  with  respect  to  the  control,  the  matrix 
calculus  allows  us  to  obtain: 


tS-  = Ru-ru,,  + 


Since  by  assumption  R is  positive  definite,  it  has  an  inverse. 
Therefore,  the  optimal  control  is  given  by: 

U*(t)  = - r”^  g'^(X)  -4^ 


Equation  5.16  is  the  control  which  minimizes  the  Hamiltonian,  since 


= R > 0 


Note  that  Equation  5.16  gives  the  optimal  feedback 
control  in  terms  of  and  not  in  terms  of  J-.  This  point  is  dis- 

cussed later  and  is  tlS^key  to  the  solution  of  the  optimal  control 
problem. 

Since  the  system  given  by  Equation  5.10  and  the  Q and 
R matrices  of  Equation  5.12  are  time  invariant,  and  since  the 


(5.14) 


(5.15) 


(5.16) 


(5.17) 


• iif  »%■*»•  siJk.  . 


optimization  is  for  a process  considered  over  an  infinite  duration,  it 
follows  that  the  performance  index  will  depend  only  upon  the  state 
variables.  This  implies  thet 


(5.18) 


Substituting  Equation  5.16  into  Equation  5.14  and  using  Equation  5.18, 
the  Hamilton-Jacobi-Bellman  equation  for  this  problem  becomes: 

% (X^  - x/  Q (X^  - X,  - (-|i) 

" " (-5^)^  ° "r  • 

Note  that  the  rotational  dependency  of  F and  G on  X,  and  that  of  X 
on  t has  been  dropped  at  this  point  for  convenience.  From  here  on 
in  the  discussion,  F is  used  instead  of  F(X),  G instead  of  G(X)  and 
X instead  of  X(t). 

Adding  and  substracting  F(X)  X^^  in  Equation  5.19, 

and  grouping  terms,  the  Hamilton-Jacobi-'Bellman  equation  becomes 

(Xr  - x/  Q(X^-X)-<4  (-|^)^  GR"’  o'" 

Notice  that  Equation  5.20  is  similar  to  the  Hamilton-Jacobi-Bellman 
equation  for  the  standard  linear  regulator  problem  (Athans  and  Falb, 
1966),  except  for  the  last  term  which  involves  [ F(X)  X^^  + G(X)  U^^]. 

5.2.4  An  Approximate  Solution  to  the  Optimal  Control  Problem 

Equation  5.20  is  a non-linear  first  order  partial  dif- 
ferential equation  for  the  optimal  performance  index.  If  this  equation 
can  be  solved  for  J,  as  a function  of  X,  a feedback  control  law  can 


GR  ’ g"^  ^ 


SX 


(5.19) 
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be  obtained.  However,  from  inspection  of  Equation  5.16  the  optimal 
feedback  control  law  does  not  depend  directly  on  J,  but  depends  on 
Therefore,  it  is  the  solution  of  in  terms  of  X which  is 

r^lly  of  interest  in  finding  a feedback  ccfmrol  law.  From  this  point 
of  view.  Equation  5.20  can  be  considered  as  a non-linear  equation  in 
the  unknown  ). 


From  physical  insight  into  the  nature  of  the  problem 
and  from  inspection  of  the  structure  of  Equation  5.20,  assume  that 
the  following  approximate  relationship  holds 


for  values  of  X in  the  neighborhood  of  X 


Equation  5.21  gives  an  approximation  to(,.-^'^  ) for 
"reasonable"  values  of  X(t),  where  K(X)  is  an  (7  x 7)  s;jjmmetric 
matrix  whose  elements  are  a function  of  the  state  variables.  Sub- 
stituting Equation  5.21  into  Equation  5.20,  the  Hamilton-Jacobi-Bellman 
equation  can  be  written  as: 


Choose  the  matrix  K(X),  such  that  for  every  value  of  X 
positive  definite  solution  to  the  matrix  equation: 


Equation  5.23  is  the  steady  state  matrix  Riccati  equation  (Anderson 
and  Moore,  1971),  and  is  a function  of  X.  Appendix  C presents  an 
iterative  method  for  solving  this  equation  for  each  value  of  X. 


A unique  positive  definite  solution  to  Equation  5.23  exists 
if  the  coefficient  matrices  of  the  system  are  controllable.  Thus, 


Equation  5.23  has  a unique  positive  definite  solution  if  the  pair  F(X(t)) 
G(X(t))  is  chosen  such  that  the  matrix 


M = [G(X)  : F(X)  G(X)  ! , . . ! F®(X)  G(X)  ] 

has  rank  7 for  all  values  of  X in  the  range  of  interest.  Wernli  and 
Cook  (1975)  contains  a discussion  of  this  type  of  equation. 

Using  Equation  5.23,  Equation  5.22  reduces  to 

(X-Xp,)"^  K (FX^  + GU^)  = 0 (5.24) 


If  Equation  5.24  is  approximately  zero  for  the  range  of 
values  of  X of  interest  in  the  problem,  then  Equation  5.21  gives  a 
good  approximation  for  . Notice  that  as  X(t)  approaches  X the 

approximation  becomes  be^^er  and  better,  since  [ F(X)  Xp  + G(>^  Up  ] -•  0 
as  X - Xr. 


If  the  range  of  X in  the  problem  is  restricted  to  values 
for  which  Equation  5.24  is  true,  the  approximate  optimal  feedback 
control  law  is  given  by: 


U*(t)  = U^  - R ^g"^(X)  K(X)  (X(t)  - Xp,) 


(5.25) 


As  X(t)  approaches  Xr,  the  optimal  control  approaches 
Ur  and  Equation  5,25  becomes  a better  and  better  approximation  to 
the  exact  optimal  feedback  control  law  for  the  optimization  problem 
posed  in  Section  5.2.1. 

5.2.5  Structure  of  the  Closed-Loop  System 

Using  the  approxinnate  optimal  feedback  control  law  of 
Equation  5.25  results  in  the  closed-loop  system 


X(t)  = F(X)  X(t)  + 


G(X)  U^  - GR  ^G^K  (X(t)  - X ) (5.26) 
R R 
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right  hand  side  of  Equation  5.26 
loop  system  reduces  to 


Adding  and  subtracting  F(X)  Xp  to  the 
and  rearranging  the  terms,  the  closed 


X(t)  = + [F  - GR  ’ K]  (X(t)  - Xpj) 

+ F(X)  Xpj  + G(X) 


(5.27) 


Equation  5.27  shows  that  the  structure  of  the  closed  loop  system  is 
such  that  the  rate  of  change  of  the  state  variables  is  linearly  related 
to  the  state  error  [ X(t)  - Xp].  Therefore,  if  the  system  is  at  the 
reference  state  it  will  stay  there.  This  implies  that  the  reference 
trajectory  for  a cruising  problem  is  an  optimal  solution  to  the  problem 
presented.  This  concurs  with  intuition,  i.e.,  the  mathematics  have 
led  to  no  surprises  for  the  relatively  simple  problem  of  maintaining 
a cruise  attitude.  Figure  9 shows  a block  diagram  of  the  closed-loop 
system. 

5.2.6  Stability  of  the  Closed-Loop  System 

The  stability  of  the  closed-loop  system  is  discussed  in 
this  section.  Again,  if  the  mathematical  derivations  are  to  agree  with 
our  intuition,  we  rationalize  that  the  derived  solution  should  prove  to 
yield  stable  results  since  we  are  examining  the  cruise  phase  which 
intuitively  should  be  steady  and  smooth.  Liapunov's  direct  method  is 
applied  to  the  system  for  values  of  X in  the  neighborhood  of  the  refer- 
ence state  Xr.  (Padulo  and  Arbib  (1974)  contains  a discussion  of 
Liapunov's  direct  method,  while  Anderson  and  Moore,  1971  contains 
an  application  to  optimal  feedback  control  problems.) 

The  reference  state  Xp  is  an  equilibrium  point  of  the 
closed-loop  system,  since  from  Equation  5.27,  X(t)  = O when  X(t)  = Xp. 
Choose  as  a Liapunov  function  for  the  equilibrium  point  Xp 

V(X)  = (X(t)  - Xpj]^  K(X)  [X(t)  - X^]  (5.28) 

which  is  positive  definite  since  K(X)  is  the  positive  definite  solution 
of  the  algebraic  Riccati  equation.  Differentiating  V(X)  with  respect 
to  time  and  using  Equation  5.27  for  X(t),  yields 
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V(X)  = [X(t)  - Xp^r  [KF  - K GR  ^ g"'^  K]  (X(t)  - X^^) 


+ (X(t)  - X^)"^  K (F  X^  + GU^) 

+ 3^  (X(t)  - Xp,/  [— ^ K(X)j  (X(t)  - X^) 


(5.29) 


For  X in  the  neighborhood  of  Xp,  the  second  term  on  the  righthand 
side  of  Equation  5.29  is  approximately  zero.  The  last  term  on  the 
righthand  side  of  Equation  5.29  involves  the  time  derivative  of  the 
matrix  K.  The  general  element  (i,  j)  of  the  K matrix  derivative  will 
be  of  the  form 


dt 


K.cx) 


-dkjj(X)  - 

bX 


X(t) 


The  partial  derivatives 


rak,.(x)  1 
. 3x  J 


will  be  small  since  the  values  of 


the  elements  of  the  F(X)  and  G(X)  matrices  do  not  change  greatly  for 
the  range  of  values  of  X of  interest.  Therefore,  the  time  derivative 
of  V(X)  can  be  approximated  as 


V (X)  = [X(t)  - X [KF  - K GR  ^ G^  K](X(t)  - X^)  (5.30) 

rs  R 


Making  use  of  the  algebraic  Riccati  equation.  Equation  5.30  can  be 
shown  to  be  equivalent  to 


V(X)  = - 3^  (X(t)  - Xp^)"'’[Q  + K GR  ’ g''’k]  (X(t)-Xj^)  (5.31) 


Since  Q is  assumed  to  be  chosen  to  be  positive  definite,  then  V is 
negative  definite,  and  thus  the  closed-loop  system  is  asymptotically 
stable  with  respect  to  the  reference  state  X^^  for  values  of  X(t)  in  the 
neighborhood  of  Xp. 
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5.3 


CPM  For  Cruising  Segment  of  Aircraft  Mission 


The  approximate  optimal  feedback  control  law  found  in 
Section  5.2  can  now  be  used  with  the  results  presented  in  Section  4 
to  find  the  CPM  for  Segment  4 of  the  aircraft  mission.  First,  the 
"cost-to-go"  function  is  derived.  Next  the  approximate  CPM  is 
derived  based  on  the  approximate  optimal  control. 


5.3.1 


"Cost-to-Go"  Function,  g*[X(t)] 


In  Section  4 it  was  shown  that  the  "cost-to-go"  function 
fl*[X(t)]  evaluated  using  optimal  control  satisfied  the  following  equation: 


d g*[X(t)] 
dt 


+ E[X(t),  U*(t)]  = 0 


Since  8 is  only  a function  of  the  state. 


d g*[X(t)] 


U*(t) 


Using  Equations  5.33,  5.10,  5.12  aund  5.25,  Equation 
5.32  for  this  example  reduces  to 


d g*[X(t)] 


+ E [X(t),  U*(t)] 


K-^) 

/de*\  ^ 

\ dx/ 


(X  - Xp,)"^  K (F  - GR  ’ g"^  K)  (X  - X^) 


(F  Xp  + G Upj)  = 0 


.1 


As  an  approximation  to  I 


be 


choose 


a»’  ~ 


Using  the  approximation  of  Equation  5.35,  Equation  5.34  becomes 


(X  - K [F  X^  + G U ] = 0 


R 


R 


R^ 


If  the  left-hand  side  of  Equation  5.36  is  approximately  zero  then  the 
choice  of  defined  by  Equation  5.35  is  a good  approximation. 

Notice  that^quation  5.36  is  the  same  as  Equation  5.24  and  hence, 
the  comments  for  Equation  5.24  also  apply  to  Equation  5.36. 


5.3.2 


CPM  For  General  Cruising  Problem 


The  continuous  performance  measure  was  developed  in 
Section  4 for  a general  class  of  problems.  The  CPM  is  given  by 
Equation  4.19  which  for  this  specific  problem  can  be  written  as: 


<#.[X(t),  U(t)] 


X (t) 


U(t) 


since  0*  only  depends  on  the  state.  Making  use  of  Equation^5.7  for 
X,  Equation  5.5  for  E [X(t),  U(t)]  and  Equation  5.35  for  , the 

CPM  for  this  example  is  given  by: 


</.[X(t),  U(t)]  = 3^  (X^  - X)  Q (Xp^  - X) 


R 


+ (Upj  - U)  R - U) 


+ (X  - Xpj)  K (FX^  + GU^) 


R' 


1 


(5.35) 


(5.36) 


+ E[X(t),  U(t)]  (5.37) 


(5.38) 


1 

] 

! 

j 


If  the  approximate  optimal  control  given  by  Equation  5.25  is  used  in 
Equation  5.38  the  CPM  is  approximately  equal  to  zero;  since  Equation 
5.36  is  approximately  zero  for  the  values  of  X of  interest. 

Assume  that  the  operators  present  control  action  can 
be  written  as  the  approximate  optimal  control  plus  a control  error, 
e(t),  that  is: 

U(t)  = U*(t)  + e(t)  (5.39) 


Using  Equation  5.39  in  Equation  5.38,  the  CPM  can  be  written  in 
terms  of  the  control  error  as: 

^[e(t)]  = '4  e\t)  R e(t)  + (X  - X^)"'"  K [PX^+GU^]  (5.40) 


However,  since  it  is  assumed  that  Equation  5.36  holds  for  the  value  of 
X considered. 


</>[e(t)]  5!  e\t)  Re(t)  (5.41) 

Note  that  the  CPM  given  by  Equation  5.41  depends  only  on  the  control 
error. 

5.4  Computer  Simulation 

In  order  to  demonstrate  the  CPM  technique  developed  in 
the  preceeding  sections,  a digital  computer  program  weis  written  to 
solve  the  aircraft  equations,  optimal  control  law,  auto-pilot  control 
law,  and  CPM  for  Segment  4 of  the  mission.  The  aircraft  equations 
used  in  this  simulation  are  given  in  Section  5.1.  The  optimal  control 
law  and  CPM  implemented  are  those  developed  in  Sections  5.2  and 
5.3  respectively.  Auto-pilot  equations  were  used,  to  generate  a control 
vector  U(t)  that  would  fly  the  aircraft  in  a stable  but  non-optimal  manner 
in  order  to  demonstrate  the  mecisurement  capability  of  the  CPM. 

A FORTRAN  digital  computer  program  written  to  demon- 
strate the  CPM  applied  to  Segment  4 of  the  mission  is  documented  in 
this  section.  Appendix  B contains  a more  detailed  description  and  a 
listing  of  the  program. 
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5.4.1  Auto-pilot 

The  auto-pilot  designed  to  correct  initial  aircraft  errors 
and  bring  the  aircraft  to  the  steady  state  flight  conditions,  is  as 
follows: 

The  control  Ui(t)  representing  the  longitudinal  stick 
position  which  controls  the  rate  of  change  of  angle  of  attack  is  pro- 
portional to  the  altitude  error  Zg,  the  rate  of  change  of  altitude,  Zg, 
and  the  rate  of  change  of  the  flight  path  angle,  y . However  the 
altitude  error  was  hard  limited  by: 

+ 100.0,  if  (Z  - Z (t))  > 100.0 

e e^  e 

I 

, if  -100.0  < (Z  - Z (t))<  100.0 

- 100.0,  if(Z  - Z (t))  < - 100.0  (5.42) 

^R  ^ 

where  the  reference  altitude  2g^^  equals  18,000  feet  for  Segment  4. 

The  auto-pilot  control  Ui  was  expressed  as  follows: 

' - U (t)  = 0.001  AZ  - 0.001  Z (t)  - 4.0  V (t)  (5.43) 

. j 1 e e 

\ ' • 

I 

I;  If  «(t)  > 0.2  and  Ui(t)  > 0,  then  Ui(t)  was  redefined  U^(t)  = 0. 

, Similarly,  if  « (t)  < - 0.2  and  U^(t)  < 0,  then  U^(t)  was  again  set 

^ I to  zero.  This  limiting  process  keeps  the  aircraft  model  from  pro- 

I ducing  an  excessive  angle  of  attack. 


The  control  U2(t)  that  represents  lateral  stick  position 
(to  control  the  rate  of  change  of  roll  angle  <P)  is  given  by: 


where  is  the  reference  heading,  which  for  this  problem  is  zero 
radians.  In  order  to  limit  aircraft  roll  angle  ( </> ) to  40  or  less, 

U2(t)  is  set  to  zero  if  either  </>(t)  > 0.69812  and  U2(t)  of  Equation  5.44 
is  greater  than  zero  or  if  </>(t)  < -0.69812  and  U2W  Equation  5.44  is 
less  that  zero. 

The  control  U3(t)  that  represents  normalized  percent 
throttle  is  given  by: 


UgCt)  = Ug(0) 


- /■  l- 


001  (V(t)  - V^) 


+ 0.120  V(t)>  dt 


(5.45) 


where  Vr  is  the  reference  velocity  which  for  Segment  4 is  708.876 
feet/sec,  (420  knots)  and  013(0)  is  the  initial  throttle  setting.  Since 
U3(t)  is  normalized  percent  throttle,  the  value  given  by  Equation  5.45 
must  be  between  0.0  and  1.0,  thus 


0.0  if  U (t)  < 0.0 

10 

Ug(t)  if  0.0  < Ug(t)  <1.0 
1 if  U„(t)  >1.0 

O 

This  auto-pilot  corrects  for  velocity,  heading,  and 
altitude.  It  does  not  correct  any  error  in  the  y-position  of  the  aii — 
craft. 

5.4.2  FORTRAN  Computer  Program 

A brief  description  of  the  FORTRAN  computer  program 
u.  given  in  this  subsection.  Appendix  B contains  a more  detailed 
discussion  and  documentation  of  this  program.  Figure  10  shows  a 
implifiod  flow  chart  of  the  computer  program  structure. 
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Read  initial  conditions, 

Q,  R,  etc.  Initialization 
of  matrices,  etc. 


Compute  new  F(X),  and  G(X) 
matrix  for  present  value  of  X. 
(Section  5.1  .2) 


Newton's  method  for  solving 
Eq.5.23  for  K(X)  matrix. 
(Appendix  C) 


Solve  Equation  5.25 
Section  5.2. 


Implement  Equations 
of  Section  5.4.1 


Compute  CPM  with 
Equation  5.38 
Section  5.3 


Numerical  integration  of 

aircraft  equations  of  Section  5.1.2. 

Test  for  stop  condition. 


FIGURE  10  FLOW  CHART  OF  COMPUTER  PROGRAM  STRUCTURE 
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In  the  initialization  section  of  the  program,  variables 
are  defined,  dimensioned  and  initialized  and  the  initial  conditions, 
reference  conditions  and  diagonal  elements  of  the  Q and  R matrices 
are  read.  In  the^  second  section,  the  elements  of  the  F matrix  and 
G matrix  are  calculated  for  the  present  value  of  the  state  variables, 

X.  The  defining  relationship  for  the  non-zero  elements  of  these 
matrices  are  given  in  Section  5.1.2. 

Block  3 of  coding  implements  an  iterative  method  of 
computing  for  the  present  value  of  X,  and  the  matrix  K(X),  which  is  the 
solution  to  Equation  5.23.  The  matrices  F(X)  and  G(X)  calculated  in 
the  previous  section  of  the  program  are  used  in  this  section.  Appendix 
C contains  a detailed  discussion  of  an  Iterative  technique  for  algebraic 
steady  state  Riccati  equation  computations . 

Once  a numerical  value  for  the  elements  of  the  matrix 
K(X)  has  been  found,  the  approximate  optimal  control  law  is  calculated. 
Equation  5.25  of  Section  5.2  is  implemented  in  the  program.  However, 
since  in  the  development  of  Section  5.2  no  limits  were  placed  on  the 
control  variables,  it  was  deemed  appropriate  to  use  the  same  limits 
I used  in  the  auto-pilot. 

Block  5 of  the  computer  program  implements  the  auto- 
pilot equations  discussed  in  Section  5.4.1.  Values  of  the  control 
variables  are  calculated  based  on  the  present  values  of  the  aircraft 
variables . 

Next,  (Block  6)  values  of  the  auto-pilot  control  and  the 
optimal  control  are  used  to  compute  the  CPM  from  Equation  5.41  . 

In  the  final  section  of  the  program,  the  aircraft  variables  are  updated, 
j First,  either  the  auto-pilot  control  or  the  approximate  optimal  control 

is  chosen  to  control  the  aircraft.  This  is  done  by  logical  comparison 
based  on  the  value  of  an  input  parameter  that  was  read  in  the  initialization 
section  of  the  program.  Then  the  next  value  of  the  aircraft  dynamic 
variables  is  calculated.  This  is  done  by  numerically  integrating  the 
differential  equations  of  the  aircraft  given  in  Section  3.  Rectangular 
numerical  integration  is  used  with  a step  size  of  0.5  seconds.  The 
program  then  loops  back  and  new  values  of  the  aircraft  variables 
are  used  to  update  F(X)  and  G(X).  If,  however,  the  aircraft  has 
flown  for  the  predetermined  amount  of  time,  the  program  terminates 
execution  and  stops . 


5.4.3 


Example  oP  Program  Output 


The  output  of  the  computer  program  is  presented  for  a 
typical  run  for  purposes  of  documentation  and  demonstration.  The 
initial  conditions  chosen  for  the  aircraft  dynamic  variables  at  the  start 
of  Segment  4 of  the  mission  are: 


« (0) 

0.1  radians  (5.7 

degrees) 

<^(0) 

= 

0.1  radians 

1^(0) 

= 

0.1  radians  (5.7 

degrees) 

7(0) 

= 

0.1  radians 

V(0) 

r: 

708.80  ft/sec. 

o 

0) 

= 

0.0  ft. 

Z^(0) 

= 

17,000  ft. 

X^(0) 

= 

0.0  ft. 

Thus  the  aircraft  model  starts  out  1,000  feet  below  the  reference  with 
a misalignment  of  approximately  5.7  degrees  in  heading.  The  attitude 
is  pitched  up  and  rolling  slightly  to  the  right.  The  initial  velocity  is 
approximately  that  of  the  reference . The  reference  values  of  these 
variables  for  a steady  state  flight  condition  in  Segment  4 are  given  in 
Section  5.1.1.  The  initial  conditions  chosen  for  the  state  variables  are 
in  the  neighborhood  of  the  reference  state  variables.  So  that,  the 
approximate  optimal  control  of  Section  5.2.4  is  applicable. 

The  Q and  R matrix  element  values  were  chosen  to  give 
the  solution  trajectories  desired;  but  the  exact  relationship  between  Q 
and  R element  values  and  the  solution  trajectory  characteristics  is  not 
known  before  the  optimal  solution  is  obtained.  As  an  initial  guess,  the 
values  chosen  are: 


R 


10  0 0 
0 10  0 
0 0 10 
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and 


1 

0 
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0 

0 

0 

0 

0 

io“^ 

CD 

1 

o 
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0 

o 

1 

00 

0 

0 

o 

1 

00 

io“’ 

0 

0 

0 

0 

0 

0 

0 

io”^ 

0 

0 

0 

0 

0 

0 

0 

io”^ 

0 

0 

0 

io“^ 

0 

0 

0 

10“^^ 

0 

0 

0 

0 

0 

0 

0 

io‘ 

The  R matrix  was  chosen  as  the  positive  definite  diagonal 
matrix  with  the  three  diagonal  elements  all  equal  to  10.  This  was  done 
because  it  was  felt  that  the  error  between  the  control  (u)  and  reference 
control  Up  should  be  weighed  more  heavily  than  the  state  errors  as 
weighted  by  the  Q matrix.  The  purpose  for  this  choice  was  to  try  to 
keep  the  optimal  control  values  (U*)  small.  Also  it  was  felt  that  one 
control  should  be  weighted  the  same  as  any  other,  that  is  there  did 
not  seem  to  be  any  reason  for  unequal  weights.  Although  one  could 
develop  rational  arguments  for  other  weights,  this  issue  was  not  explored 

The  form  of  the  Q matrix  was  chosen  for  the  following 
reasons.  It  was  decided  to  weight  the  angle  of  attack  (<»)  error  the 
heaviest  to  keep  the  aircraft  model  from  excessive  angles  of  attack. 
Excessive  angles  of  attack  can  lead  to  instability,  so  this  variable  is 
of  some  concern.  The  assigned  weight  reflects  the  seriousness  or 
gravity  of  allowing  the  aircraft  to  assume  high  angles  of  attack.  Roll 
angle,  heading  ^ngle,  flight  path  angle,  and  velocity  were  all  weighted 
the  same,  (10  ) but  a factor  of  ten  less  than  angle  of  attack.  The  y 
position  and  altitude  were  both  weighed  by  lO""^,  since  it  was  felt  that 
these  states  could  be  corrected  slowly  over  the  segment.  Note  they 
are  weighted  1/1000  times  the  weighting  of  roll  angle,  heading  angle, 
flight  path  angle  and  velocity;  and  1/10,000  times  the  weighting  of 
angle  of  attack. 
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The  off-diagonal  terms  in  the  Q matrix  were  included 
to  introduce  a weighted  coupling  of  heading  error  and  y-position  error 
into  the  roll  angle  in  order  to  allow  the  aircraft  to  roll  and  to  correct 
for  heading  and  y position  error.  Again,  relatively  small  weights  were 
used  reflecting  moderate  preference  rather  than  grave  concern. 

The  Q matrix  is  positive  definite  and  symmetric.  This 
choice  of  Q and  R matrices  is  only  a preliminary  one  used  for  demon- 
stration  of  the  computational  technique.  In  order  to  determine  the 
suitable  values  of  the  elements  of  Q and  R,  the  simulation  would  have 
to  be  run  with  the  optimal  control  "flying"  the  aircraft  model.  From 
inspection  of  the  resulting  trajectories,  the  Q and  R matrices  could 
then  be  modified  and  the  simulation  repeated  with  these  new  values. 

This  process  is  repeated  until  the  elements  of  Q and  R are  those  which 
give  the  desired  solution  trajectories . However,  due  to  lack  of  time, 
only  the  trajectory  with  the  initial  condition  and  values  of  Q and  R given 
above  was  run  to  demonstrate  the  program. 

The  simulation  was  run  for  30  seconds  of  flight  time  on 
an  IBM  370-155  digital  computer.  In  the  present  version  of  the  computer 
program  the  execution  time  is  greater  than  real  time.  Several  sug- 
gestions are  presented  in  Section  6 to  remedy  this  situation  to  explore 
the  feasibility  of  calculating  the  CPM  in  real  time. 

Figure  11  is  a sample  of  the  printout  for  one  iteration, 

0.5  seconds  of  flight  time,  through  the  program.  Figures  12  through 
19  show  plots  of  the  aircraft  variables  resulting  from  the  auto-pilot 
control.  Figure  20  is  a plot  of  the  CPM  versus  flight  time  for  this 
non-optimal,  auto-pilot  control.  Summary  measures,  mean  and  variance 
are  given  on  the  figure. 

The  mean  was  calculated  using  the  time  weighted  average: 


where 


A t 


^2-S 


N-1 


L 

i—n 


(i) 


t^  = N A t 
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and 


At  = 0.5  secs . 

N = 60 

with 

N-i 

^ (i)  = 133.2281 

i=0 

The  variance  was  calculated  from  the  expectation  formula: 

= E - ^(i))^j 
= E [(^  (i))^]  - [e  (<^  (i))]^ 

The  expectation  of  the  squared  scores  was  again  calculated 
using  the  time  weighted  average: 


N-1 

E W)  1 ^ E [«^  Ci)] 

2 1 i=0 


With  ^ (i) 


= 355.1372, 

the  variance  is  = 5.919  - 4.935  = 0.9839 


follow: 


Alternately,  one  might  use  the  statistical  formulas  that 


<(,  = 


N-1 

E 

i=0 

N 


133.2881 

60 


= 2.22 
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and 


N-1 

[kO?  - 

A 2 ^ i=0 

“ N (N-1) 

2 

60(355,1372)  - (133.2881) 

3540 


= 1.001 


In  either  case,  the  variability  in  performance  as  reflected 
by  is  relatively  small.  No  attempt  was  made  to  explore  higher 

order  moments.  These  would  reflect  the  degree  of  assymmetry  in  the 
measure,  i.e.,  whether  performance  was  skewed  to  the  higher  or  lower 
scores,  or  was  symmetrical  about  the  mean. 
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FIGURE  17  VELOCITY  vs.  TIME 


FIGURE  18  vs.  TIME 


(4)  z 


FIGURE  19  ALTITUDE  2 vs,  TIME 


Statistics 


FIGURE  20  CONTINUOUS  PERFORMANCE  MEASURE,  <<>(t)  vs,  TIME 


Inspecting  Figures  12  through  19,  the  autopilot  rapidly 
corrects  the  initial  altitude  error,  bringing  the  aircraft  model  to  18,000 
feet  in  approximately  15  seconds.  However,  in  Figure  18  the  altitude 
correction  oscillates  slightly  about  18,000  feet  reference.  The  auto- 
pilot rolls  the  aircraft  model  over  slowly  to  correct  the  initial  heading 
error  to  zero  as  seen  in  Figure  14.  The  autopilot's  attempt  to  correct 
the  initial  misalignment  in  angle  of  attack  and  flight  path  angle  is 
highly  oscillatory  as  can  be  seen  in  Figures  13  and  16.  The  autopilot 
is  attempting  to  bring  y to  zero  radians  and  a to  0.0594  radians  but 
undershoots  and  then  overshoots  these  reference  values.  The  throttle 
control  is  slowly  varying  the  velocity  as  seen  in  Figure  17.  Over  the 
30  seconds  of  this  simulation,  the  aircraft  velocity  was  about  15  feet/ 
second  below  the  reference.  As  seen  in  Figure  18,  the  autopilot  does 
not  correct  the  y-position  error  of  the  aircraft  model.  This  is  because 
it  was  not  designed  to  do  so.  While  this  is  a "poor"  autopilot  design, 
it  provided  a good  check  on  the  reasonableness  of  the  computer  output 
and  assured  a non— optimal  performance  for  evaluation  via  the  CPM,  as 
reflected  in  Figure  20. 
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CONCLUSIONS  AND  RECOMMENDATIONS 


6.  1 Conclusions 

This  investigation  of  continuous  performance  measurement 
(CPM)  (and  continuous  performance  evaluation)  shows  that  summary  measures 
developed  from  mission  segment  specifications,  can  be  converted  into 
an  instantaneous  performance  measure.  This  can  be  accomplished  with 
optimal  control  theory  by  either  linearizing  the  plant  (aircraft)  equations 
as  is  most  frequently  done  in  optimal  control  problems,  or  solving,  at 
least  by  approximation,  the  optimal  control  for  the  non-linear  aircraft 
equations.  The  latter  approach  was  explored  here. 

Selection  of  the  Q weighting  matrix  which  is  part  of  the 
summary  performance  measure  can  be  accomplished  in  at  least  three 
ways.  One  way  is  to  ask  experienced  pilots  or  other  personnel  familiar 
with  the  mission  performance  to  select  numerical  values  reflecting  the 
relative  importance  of  each  flight  factor.  Another  way  is  to  pick  Q 
matrix  values  with  a simple  form,  say  with  1 *s  on  the  diagonal  and  O's 
elsewhere,  and  subsequently  solve  for  the  corresponding  optimal  control 
law  and  aircraft  trajectories . The  third  approach  (really  a variation  of 
either  of  the  two  previous  approaches)  would  be  to  reset  the  values  of 
the  Q matrix  after  examining  the  resulting  "optimal"  aircraft  trajectories . 
Systematic  trial  and  error  adjustments  to  the  Q matrix  entries  would 
then  produce  a variety  of  trajectories  for  examination.  If  one  had  pre- 
defined notions  of  what  the  desired  trajectory  should  look  like,  the  Q 
values  might  be  approximated  by  iteratively  adjusting  the  Q entries  in 
directions  known  (from  the  preliminary  trial-and-error  runs)  to  produce 
"more  desirable"  trajectories . 

There  was  not  sufficient  time  available  on  the  contract  to 
thoroughly  investigate  the  relationship  between  the  selected  Q matrix 
and  the  resultant  optimal  solution  trajectories  so  that  little  can  be  con- 
cluded about  that  relationship.  It  would  be  of  interest  to  identify  optimal 
response  characteristics  with  Q and  R matrix  element  values.  An 
I additional  area  of  work  which  was  not  investigated  extensively  is  the 

j region  of  validity  of  the  approximate  optimal  control  solution.  It  should 

I be  noted,  however,  that  the  approximation  improves  as  the  aircraft 

position  approaches  the  reference  flight  path  and  becomes  the  exact 
solution  when  the  aircraft  is  on  the  reference  flight  path.  Thus,  the 
region  where  the  approximation  holds  to  a given  degree  is  the  space 
immediately  surrounding  the  reference  flight  path.  The  reason  the  con- 
trol law  developed  becomes  only  approximately  optimal  when  the  aircraft 
is  off  the  reference  path  is  that  the  aircraft  dynamics  change  as  a 
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function  of  the  deviation  from  the  reference  path.  If  the  aircraft 
dynamics  were  constant  the  solution  would  not  be  approximate.  Thus, 
the  preferred  way  to  pick  the  aircraft  dynamic  (F  and  G)  matrices  and 
corresponding  state  variables  would  be  to  render  matrices  F and  G 
as  constant  as  possible  as  a function  of  the  deviation  from  the  reference 
flight  path.  Fiowever,  available  time  did  not  allow  a thorough  investi- 
gation of  the  benefits  to  be  obtained  choosing  various  alternative  structures 
of  the  aircraft  equations.  Also,  the  alternate  approach  to  the  problem 
would  have  been  to  linearize  the  representation  of  the  aircraft  model  and 
proceed  with  an  exact  solution  for  the  linear  representation.  The  results 
could  be  subjected  to  sensitivity  analysis  to  determine  how  the  lineari- 
zation affected  the  results.  Further  comparisons  might  lead  to  insights 
as  to  whether  linearization  of  a non-linear  phenomenon  was  a good  or 
bad  compromise  versus  the  need  to  approximate  (rather  than  determine 
exactly)  the  solution  for  the  non-linear  model.  These  are  rather  formi- 
dable issues  and  were  not  addressed  here.  They  should  be  explored  in 
future  work. 

A major  problem  in  implementing  the  continuous  performance 
rn0^sure  on-line  us  ng  the  non— linear  aircraft  model  is  the  computational 
load  requires  excessive  computer  time.  With  the  approach  developed  to 
the  point  described  in  this  report,  the  computational  load  is  extreme  and 
may  prevent  real  time  solution.  However,  it  should  be  recognized  that 
the  computation  described  here  solves  for  both  the  approximate  optimal 
control  law  and  the  GPM,  But  the  optimal  control  law  can  be  precomputed 
and  stored,  since  only  the  GPM  need  be  implemented  on-line.  For 
example,  the  function  K,  which  provides  ttie  feedback  control  law  gains, 
can  be  represented  by  a pre-computed  function  of  the  state  variables 
which  might  be  evaluated  more  rapidly  on-line  to  implement  the  desired 
GPM. 


6.2  Recommendations 

In  order  to  realize  the  benefits  available  from  using  a con- 
tinuous performance  measure  to  evaluate  manual  flight  control  performance, 
the  following  steps  are  recommended: 

1 . The  computation  time  required  to  compute  the  GPM 
should  be  reduced  so  that  it  can  be  computed  in  real 
time.  This  might  be  accomplished  by  approximating 
K as  a function  of  the  state  variables  and/or  im- 
proving the  computational  efficiency  of  the  program. 


.. 


2. 


The  error  weighting  of  the  CPM  must  be  evaluated 
by  examination  of  the  continuous  scoring  of  flights 
by  human  subjects.  Note  that  the  trajectory  eval- 
uation involving  adjustment  of  the  Q matrix  is  to 
obtain  satisfactory  optimal  aircraft  trajectories  - 
the  trajectories  obtained  when  the  aircraft  motion 
is  governed  by  the  optimal  control  law.  These 
trajectories  were  referred  to  as  preferred  trajec- 
tories and  serve  as  continuous  criteria  for  the 
CPM.  As  indicated  above,  the  weighting  of 
deviations  from  the  continuous  criteria  - deviations 
that  occur  when  the  aircraft  motion  is  governed 
by  a human  operator  - must  be  evaluated. 

As  shown  by  the  section  on  sensitivity  analysis,  the  control 
deviation  weighting  is  governed  by  the  R matrix.  Consequently,  the 
credibility  of  the  CPM  rests  on  the  values  one  employs  in  the  objective 
function.  Once  again,  the  performance  score  rests  upon  proper  selec- 
tion of  criteria.  The  goals  have  to  be  defined  and  agreed  upon  if 
performance  measurement  is  to  be  meaningful . CPM  does  not  resolve 
the  problem  of  choosing  the  goals,  but  it  does  provide  a performance 
index  which  is  inextricably  linked  to  the  quantification  of  objectives, 
however  one  wishes  to  accomplish  that  task. 
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APPENDIX  A 

AERODYNAMIC  EQUATIONS  FROM 
SUBROUTINE  ADCOMP 


GLOSSARY 

AREA 

2 

Area  of  aircraft  in  square  feet  - set  to  202  (ft) 

CD 

Coefficient  of  drag 

CL 

Coefficient  of  lift 

D 

Drag  in  lbs. 

DENS 

Air  density 

DT 

Frame  time  in  seconds  (or  fractions  of  a second) 

FEBA 

Forward  Edge  of  Battle  Area,  a hypothetical  boundary 
separating  safe  and  potentially  hostile  territories 

line 

FLIR 

Forward  Looking  Infra  Red,  a sensor  often  used  at  night 
when  visible  light  is  not  available;  a very  sensitive 
"heat"  related  detection  and  display  system 

GCA 

Ground  Controlled  Approach 

GCI 

Ground  Controlled  Intercept,  radar  operator  "vectors" 
aircraft  to  some  desired  location  by  telling  the  pilot 
what  altitude,  heading  and  airspeed  should  be  attained 

an 

HF/SSB 

High  Frequency/Single  Side  Band  - a type  of  radio 
transmitter  and  receiver 

K 

Scaling  factor  in  a equation 

L 

Lift 

Mi 

Mach  of  aircraft 

MASS 

Weight  of  aircraft  divided  by  G - SLUGS 

MAXG 

MING 

Set  to  +15  1 

1 Aircraft  scaling  factors 
Set  to  -5  ' 

MT 

Maximum  thrust  - a function  of  altitude,  velocity 

• >•  . 
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PRES 


Air  Pressure 


Q Dynamic  pressure 

SS  Speed  of  sound  in  ft/sec 

TA  Terrain  Avoidance  - altering  course  to  avoid  terrain  when 

altitude  to  be  maintained  is  lower  than  terrain  features 

TACAN  Tactical  Air  Navigation,  a navigation  aid  originally 

developed  by  and  for  the  military  but  now  used  in  commer- 
cial aviation  as  well 

TEMP  Air  temperature  in  degrees 

TF  Terrain  Following  - staying  close  to  the  ground,  diving 

and  climbing  but  maintaining  same  heading  (in  contrast 
to  TA) 

UHF/ADF  Ultra  High  Frequency/ Automatic  Direction  Finding,  a 

radio  based  navigation  aid 

V Velocity  of  aircraft  ft/sec 

V Rate  of  change  of  velocity  in  ft/sec 

VFR  Visual  Flight  Rules  (in  contrast  to  IFR  - instrument 

flight  rules) 

W Weight  of  aircraft  in  lbs.  - set  to  17,000  lbs. 

Xg  X position  of  aircraft  - feet 

Xg  Rate  of  change  in  X coordinate  - ft/sec 

Vg  position  of  aircraft  - feet 

Vg  Rate  of  change  in  r coordinate  - ft/sec 

Zg  Altitude  in  feet 

Zg  Rate  of  change  in  Zg  coordinate  in  ft/sec 
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1 

I 


n 


a 

y 

y 


M2 


4> 


Attack  angle  in  radians 

Rate  of  change  of  attack  angle  in  radians/sec 
Flight  path  angle  - radians 

Rate  of  change  of  flight  path  angle  in  radians/sec 

Input  in  rad  ians/sec,  controls  the  rate  of  change  of  attack 
(proportional  to  fore  and  aft  movements  of  the  stick) 

Input  in  radians/sec, controls  the  rate  of  change  of  roll 
angle  (proportional  to  lateral  or  side-to-side  movements 
of  the  stick) 

Input  as  normalized  percentage  of  throttle 
(proportional  to  throttle  position) 

Heading  angle  - radians 

Rate  of  change  of  heading  angle  in  radians/sec 
Roll  angle  in  radians 

Rate  of  change  of  roll  angle  in  radians/sec 


I 

I 


I 
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This  appendix  presents  a summary  of  the  model  of 
flight  dynamics  that  was  used  in  this  contract.  The  computer  program 
ADCOMP,  which  provides  the  coding  for  the  flight  dynamics,  was 
supplied  to  Omnemii  by  AMRL/HEB. 

The  following  aerodynamic  equations  were  extracted  from 
the  FORTRAN  subroutine  ADCOMP,  ALL  DIGITAL  COCKPIT  DISPLAY 
SYSTEM,  and  represent  those  equations  which  determine  the  simulated 
flight  characteristics  for  the  display  presented  to  subjects  in  the  real- 
time simulation.  The  subroutine  computes  all  flight  values  from  initial 
values  and  from  three  analog  inputs  representing  control  stick  positions 
and  throttle  setting  executed  by  the  subject.  The  ADCOMP  subroutine 
is  tied  to  other  subroutines  which  monitor  subject  performance  (read 
and  record  the  analog  inputs)  and  generate  the  displays  themselves. 
These  other  routines  are  not  described  in  this  appendix. 

The  following  set  of  equations  is  a listing  in  order  of 
execution  of  the  computation  steps  involved  in  the  subroutine  ADCOMP. 
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ANGLE  OF  ATTACK.  « 


The  angle  of  attack,  alpha,  is  computed  first.  The 
following  steps  are  executed  in  computing  a . 


1 . Compute  GLOAD 


Weight 


2 . Compute  the  derivative  of  « based  on  GLOAD  and  M-|  . 
When  GLOAD  > 1 , set 


a = - (GLOAD  - 1) 


When  GLOAD  < 1 set 


« = + (GLOAD  - 1) 


MAXG 


(MING)  5 


3.  Compute  present  value  of  a from  the  previous  value  of 
a and  the  present  value  of  « as: 

a = a + Of  DT 


where  DT  is  the  time  increment.  This  constitutes 
a numerical  rectangular  integration. 

4.  Test  the  value  of  or,  and  if  or  < - .2,  set  a = -0.2. 
This  limits  a at  -.2  radians. 


2.0 


ROLL  ANGLE,  <f> 


r 


Next,  the  program  computes  a new  value  for  the  roll 
angle,  4> . The  following  steps  are  executed. 

1.  Set  the  negative  derivative  of  roll  angle  to 

6 = Ug 

where  U2  is  a control  variable  which  is  proportional 
to  stick  position. 

2.  Comipute  the  present  value  of  <f>  from  the  previous 
of  3 and  the  present  value  of  6 using  rectan- 
numerical  integration.  When  the  absolute 
of  the  flight  path  angle,  y,  is  greater  than  or 
to -5;  radians,  then 

3+6  DT  + 7T 

the  absolute  value  of  y is  less  than  radians , 
6 + 6 DT 

Now  convert  the  3 values  to  positive  roll  angle: 

•A  = - 6 


value 

gular 

value 

equal 

3 = 
When 


3 = 


3.0 


COMPUTATION  OF  ENVIRONMENTAL  PARAMETERS 


The  ADCOMP  subroutine  next  computes  the  environmental 
parameters  for  the  aircraft  model  in  the  following  steps; 

1 . The  parameters  associated  with  the  atmosphere  are 
calculated  based  on  the  altitude  of  the  aircraft,  2,g. 

When  Zg  > 35,300  ft.,  set 

Temperature; 

TEMP  = -67.0 

Pressure: 

PRES 

Density; 

DENS 

When  Zg  < 


TEMP 

= 59  - (.00357  Zg) 

Di  = 

/o. 00357  Ze\ 

\ 518.4  } 

PRES 

= 2116 

DENS 

= .002378 

2.  The  speed  of  sound  is  calculated  as: 

c;s  = /_PRES_K406\  / ft.  \ 

\ DENS  ) \sec.j 

and  the  MACH  number  as 

V 

M^  = 5^ » where  V is  the  velocity  of  the  aircraft 

in  ft/sec. 

3.  The  dynamic  pressure  is  calculated  as: 

Q = 0.5  DENS  (V)^ 


= 489.456  exp 


(Ze  - 35,300.)^ 
20930.  t 


PRES 

673946. 

35,300  ft.,  set 
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4.0  CALCULATION  OF  FORCES 

The  forces  acting  on  the  aircraft  are  calculated  as 

follows: 

1 . The  coefficient  of  LIFT  is  first  calculated  by: 

CL  = .1  + 2.5  « 

Then  the  coefficient  of  DRAG  by: 

CD  = 0.03  + .27(CL)^ 

The  DRAG  is  computed  from  ■ 

D = (Q)  (CD)  (AREA) 

i 

, 2.  After  the  first  computed  value  of  CL  is  used  to 

compute  CD  and  D,  CL  and  a are  modified  according 
to  the  value  of  «,  as  follows: 

When  a > .4  and  « < .6,  set 

CL  = 1 -2.  («  - .4) 

When  n > .6,  set 

CL  = 0 and  « = .6;  if  V < 100,  set  <»  = 0. 

! 3.  The  thrust  is  computed  as  follows: 

; If  V < 1 , set  V = 1 .0 

( Compute  maximum  thrust,  MT,  depending  on  whether 

I the  after-burner  is  on  or  off.  When  after-burner  is  i 

I on , set 

( 

MT  = 2[(  (2327.  + . 1 72Zg  - . 0000031  (Z^)^)  M , +(11500.-  .25Zg)] 

When  after-burner  is  off,  set 


Next  compute  thrust  from: 

T = Mg  MT 

where  M3  is  a control  input  proportional  to  throttle. 


4.  The  component  of  applied  force  normal  to  the  flight 
path  (Lift)  is: 

L = ( (Q)  (CL)  (AREA)  ) + T sin  (a) 


I 


I 

■I 


I 


5.0 


VELOCITY,  V 


The  derivative  of  the  aircraft  velocity  is  computed 

according  to: 

" _ T cos  (g)  - D - W sin(y) 

MASS 

where  MASS  is  in  slugs.  The  present  value  of  V is  next  computed 
from  the  previous  value  of  V and  the  present  value  of  V as: 


I 


6.0  HEADING  ANGLE  4'  AND  FLIGHT  PATH  ANGLE  > 

The  present  value  of  heading  angle  4'  and  flight  path  angle 
7 are  computed  in  the  following  steps; 

1 . The  derivatives  of  ^ and  7 are  computed  from  the 
equations 

] ^ L sin  ( ^) 

MASS  cos  (7)  V 


7 _ L cos  («/»)  - W cos  (7) 

(MASS)  V 

The  present  value  of  and  7 are  computed  from  the 
previous  values  of  and  7 the  present  values  of  ^ 
and  7,  but  with  limits  in  the  following  way; 

Set  = 7+7  DT 

If  the  absolute  value  of  7^  is  less  than  radians, 
set  the  present  values  of  and  7 equal  to 

\p  = 4'  + 4'  DT 

7 = 7^ 

If  the  absolute  value  of  is  greater  than  or  equal 
to  radians,  set 

4^  = \(/  + \p  DT  + 7T 

and  set 

7 = -77-7,  if  T<  0 


7 = 7T  - 7.  , if  > 0 
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POSITION  OF  THE  AIRCRAFT 


The  position  of  the  aircraft  with  respect  to  the  earth  is 
calculated  next.  In  each  step  below,  the  derivative  is  calculated  first 
and  then  the  present  value  is  found  from  rectangular  numerical  inte- 
gration. The  steps  are  as  follows: 

1 . X-position  of  aircraft 

= V cos  (7)  cos  (yp) 
and  Xg  = Xg  + XgDT 

2.  Y-position  of  aircraft 

Vg  = V cos  (>)  sin  (yp) 
and  Yg  = Y^.  + Y'gDT 

3.  Z-position  of  aircraft  (altitude) 

Zg  = V sin  (7) 
and  Zg  = Zg  -t  ZgDT 
A listing  of  the  ADCOMP  subroutine  follows. 
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ADCOMP  SUBROUTINE 


ADCOMP  SUBROUTINE 

/ G LEVEL  20  DATE  = 7A275  16/11/33 


C 00000060 

C C00C0070 

C this  SU9«0UriNE  COMPUTES  ALL  OF  THE  MATH  USED  06000080 

C TQ  GEMEJIATE  NEK  XY  COORDINATE  POSITIONS  OF  ALL  _ . . 000000*30 

C THE  DISPLAYS  THAT  ARE  GENERATED  DURING  A SIMULATED  0C0CCC91 

C MISSION  . _ _ _ 0C000092 

C ~ ’ 00000110 

C 00000120 

C EOUATICN  OF  MOTION  TAKEN  FROM  00000130 

C nUMASH  AIRPLANE  AFPOOYNAMICS  . 00000160 

C 00000150 

C ANGLES  ___  OOOOC16C 

C OGOCO170 

C I’rtl  = R.1LL  ANGLE  (BANK)  0COC018O 

C theta  = PITCH  angle  000001*30 

C ALPHA  = angle  OF  ATTACK  OC00G20O 

C GAN-IA  = FLIGHT  PATH  ANGLE  O0OCO21C 

C PSI  = H AOlNi;  ANGLE  _ 000002  20 

C ‘ ' ' 00000230 

C FORCES  _ _ 00000260 

C - . 00000250 

C thrust  - LOS  _ __  0C000260 

C DRAG  - L8S  000002 7C 

C _ LIFT  - LOS  _ . 00000280 

C WEIGHT  - LBS  OC0002*3C 

C MASS  - SLUGS  _ . _ OC000300 

C G = 32.2  FT/SEC2  00000310 

C _ „ . 0000(^320 

C RATE  00000330 

C_ 00000360 

C VELDT  - RATE  OF  CHANGE  OF  VELOCITY  00000350 

C PSIDT  - RATE  OF  CHANGE  OF  PS  I _ _ 00000360 

C GAMDT  - RATP  OF  CHANGE  OF  GAMMA  ' 00000370 


C _ DELX  - RATE  OF  CHANGE  OF  X POSITION 

C ' DELY  - RATE  OF  CHANGE  OF  YPOSITION 

C - RAJTE  OF  CHANGE  OF  Z POSITION 

c ■ ■■  ■ ■■  

C__  POSITION  

C 

_ C _ X - PLANAR  POSITION  

I C Y - PLANAR  POSITION 

I C Z - ALTITUDE  _ 

I " C 

C ATMOSPHERE 

C 

C TRMP  - AIR  TEMPERATURE 

C PRES  - AIR  PPPSSURE 

C DENS  - AIR  DENSITY 


00D0C380 
00000390 
OC00060C 
000 0061 C 
00000620 
0000063C 
00000660 
00000650 
00000^60 
00000670 
OCOOO^PO 
00C0C69C 

00000510 

C0000520 


LEVEL  20 


MAIM 


DATE  = 74275 


16/11/33 


c 

SOUND 

1 - SP  UE  SOUND  (FT/SEC) 

00000530 

c 

MACH 

- OF  AIRCRAFT 

00000540 

c 

0 - dynamic  pressure 

0C000550 

c 

i ■ . 

0C0C0560 

r 

AERO 

' ■ 

00000570 

c 

00000580 

c 

CL  = 

Ll'^T  C'EFFICIENT  ^ 

00000590 

c 

CD  = 

DRAG  CUFFFICIENT 

00000600 

C 

0C000610 

c 

HANKN 

= NcR  RANK  ANGLE  A, 

00000620 

c 

HANK NR 

= NEW  PANK  AN(UE  IN  RADIANS 

00000630 

c 

HANKD 

= OLD  RANK  ANGLE 

- - 

00000640 

c 

CALO 

= 

r . 

000-30650. 

c 

CALV 

- 

00000660 

c 

ERTIML- 

= FRAMc  TIME 

/ 

03000670 

c 

HC.TRX 

= HDR I ZUN  CENTER  X 

0C3CC680 

c 

HC.  TR  Y 

= HORIZON  C^'.NTEP  Y 

0000C690 

c 

Hi- ACCR 

= HEAPING  CHANGE  If'  RADIANS 

00000700 

c 

H'r  ADC 

= .--lEACING  CHANGE 

00000710 

c 

hdrate 

= HEADING  FATf. 

00000720 

c 

ISPEED 

= SPEED  Or  Al.RCEAFT 

00000730 

c 

NAVG 

= AREA  NAVIGATIONAL  DATA  IS  STORED 

00000740 

c 

INCT 

= NUMBER  OF  NZVIGATIONAl  POINTS 

( TFORl) 

00000750 

c 

INCNT 

= NUMBER  CF  f:A  V i G AT  ! ’ INAL  POINTS  TO  DISPLAY 

(TFI3R2I 

00000760 

c 

ITCT 

= NUMBER  OF  TARGETS 

< TFORl) 

0000077C 

c 

ITCNT 

= NUMBER  OF  targets  TO  DISPLAY 

(TF0R2) 

0P0C0780 

c 

STHEAD 

= START  HEADING  OF  AIRCRAFT 

000007^0 

c 

SI  ZFT 

= SIZE  OF  TEWS  DISPLAY 

oooooeoo 

c 

SiZEN 

= SIZE  UF  NAVIGATll.NAL  DISPLAY 

00000810 

c 

TOANKN 

= rANC^NT  OF  NEW  BANK  ANGLE  IN  RADIANS 

00000820 

c 

TARG 

= AREA  TARGET  DATA  IS  STORED 

0000C830 

c 

TPGHDN 

= NEW  TRIG  HEADING 

00000840 

c 

XAC 

= X OF  AIRCRAFT 

00000850 

c 

XT 

= X OF  TARGET 

C0000860 

c 

YAC 

= Y CF  AIRCRAFT 

00000670 

c 

YT 

= Y OF  TARGET 

00000880 

c 

0000C890 

c 

00000900 

SUBROUTINE  "AOCOMP 
REAL  MA<G,NING 

COMMON  INCT,  ITCT,  INALIM6),  SPEE  0,  SPE  E OK , I SPO 
COMMON  ICTLP,  ITCNT,  INCNT 

COMMON  IDT  X (103)  , I (^7  Y ( 1 CO ) , I DT  YP E (1,00  » t I DTCH  A(  1001 
COMMON  IONX( 23) , IDMY (20  t INCHAR( 20) , IMCT YP (201 
COMMCM  XRA  , YR A , X LA , YL A , I T I ME R , LMPOX , LMPC Y f RM POX , RMPOY 
CCMMCN  r-PMY'.  , RPMY2,  RFMl,  RPM2  _ 

common  CX(.S)  - - 

CO“MCN  COMPXf  COMPY 


00000920 

00000930 

00000940 

O00OD950 

00000960 

0C000970 

0CCC09fi0 

00000990 

OCOOIOOO 


• ^ ^ 


. LEVEL  20 


ADCLMP  DATE  = 7AZ75  16/J1/33 


C 

C 

C 


CCM10N  KPMY3,  KPMY4 
COMMON  XX(13I,  YY(13) 

COMON  I4S(6).  1S1AS(5) 

CCMMOM  KALT,  KVVt  KCAM,  KMACH,  KGLOD 
COMMON  KALE,  KXAC , KYAC 

COMMON  MACHXYlol  ,MACMTX(5I , IVKAST,  IVOUM  

COMMON  OlGINinO) 

COMMON  IS'nTS 

COMMON  IALHXY(o»,  IALTXH(6),  fALTXY(6l,  I4LTXT(5) 

COMMON  lACCY(K),  IaCCTX(5),  IA0AY(6),  1A0ATX»5) 
common  ISkTCZ,  ISVJTC3,  ISWTCA,  ISWTC5,  ISWTC6,  ISWTC7 
C JM.iC'J  >L?HA,  ril  TA,  theta,  TPGHON,  VELOT,  DELZ,  Gl.CAO 
COMMON  ALT,  GOSPP,  lAFBMN 
common  IPRNTAC30I 

COMMON  IHuTSh',  NCSW,  1ST  ART,  IriESCT,  ICNCAR 
CCMMCN  ICNTA8(5S2I,  IMSEU(IOO) 

CGf  MCN  TX(  iJO)  ,TY(  \ ''>)  ,TCM(\CO),  TOF(  TOO)  , I TYPE  ( 3. 00  ) , ICHAPCOGJ 
common  NX(2,),  NY(?0),  5L0P(80),  NCTY(20» 

COMMON  / CA<0/1SPFE0,  FkTIME,  XAC,  YAC,  STFEAC,  SIZE'T,'  “siZEN,^ 
1 CALV,  CALD,  BETRMX,  ALFAPX,  SCALEM  _ _ _ _ 

COM'.MON  / BANK  / BANKO,  BANKN  " 

COMMON  ZRXUYVZ  X23 , U21,  Y23 , VZl , XN21,UN21,  YN21,  VN21 
COMMON  ZRASTXY/  X2 , XI,  U2,  03,  Y2 , Yi,  V2,  VI 
__C0MI-igN,  /RASNXYZ  XN2  , XN3  , UN2,_0N;.  , YNZ , YNl  VN2 , VNl 

COMMON  / LYONS  / Phi,  GAMMA,  PSI  , G,  

1 SINPHI,  COSPHI,  SINGAM,  COSGAM,  APX,  APY,  Z 


COMMON  /ARTHOK/  R,  PI,  PI2,' CONST,  C0NST2 


0C001030 
00001020 
OC001030 
C0001C4C 
00001050 
00001060 
OCOC1O70 
0C001080 
CC001090 
00001100 
00001 lie 
00001320 
00001130 
000011 AO 
C1C0OH50 
OC0013  60 
00001170 
OC 001 180 
00001100 
00001200 
00001210 
C0001220 
00001230 
000012A0 
C00C1250 
00001260 
OC001270 
00001280 
00001290 


REAL  MX,  NY,  NGN,  NOF , KALE 
REAL  LIFT  /17000.Z 


INTEGER  ♦ 2 IMSEU  _ 

INTEGcR  * 2 XRA,  YPA,  XLA,  YLV,  I NCT YP,NCTY 
INTEGER  • 2 IAS,  IVRAST,  IVDUH  _ 
integer'*  Z MACHXY 
INTEGER  * 2 0IGIN3 

integer  ♦ 2 LMPOX,  LMPC'Y,  R MPOX , RMPCV  ' 
INTEGER  * 2 PPMYl,  PPMYZ,  P.PMl,  RPM2,RPMY3, 
INTtGEP  * ? lOTX,  IDTY,  lOTYPE,  IDTCHA,  IDNX 
INTEGER  ♦ 2 C^'MPX,  COMPY,  CX 

INTEGER  * Z lALTXY,  lALHXY 

integer  * 2 lACCY,  lAOA.Y 

integer  X ^ ISWTC2,  ISWTC3,  ISMTC4,  ISRTC5 
INTEGER  * 4 HN(3X,  GNDX,  ANOX 


OOOC130C 

00001310 

00001320 

00001330 

_ 00001340 

00001350 

00001360 

0C00137C 

00001380 

C00013OC 

00001400 

C00014J.O 

RPMY4 __  000  03  42  C 

, lONY',  INCHAR',  I'NAL'IN  00001430 

00001440 

00001450 

OOOC146C 

, ISHTC6',  1SWTC7  00001470 

0C00148O 


A-16 


EVEL 


20 


AOCf'MP 


CATt  = 7A275 


16/11/33 


I'ETSGcK  Hl/1<,50/,  in/ 3(0/ 

INTSGHR  HI  ,)k/3(>3,/ , LGGK/2350/ 

INT^CEK  • 2 IHAK2I.  CGP 
INTEGER  » 7 r.MAK(;i,  HIANK/*  •/ 

EUOIVAL.fICE  (ICNCAK,  CHA.im) 

OATA  IlCI/l/.  IHC.7/0/ 

TATA  UA5PG/0/ 

LOGIC, L • I Ll(?» 

fcUtJIVAL  V„.  MEULl,  IHAFlIllt  (!HAr(2l,  LKll) 


rif'ENSI  1-4  v.OtL(*;),  SPILI^I,  DELTA13) 


D I Hi  NS  I 1.>1 
OIMPNSl  IN 
DIH'-  Mbir.'N 
OIMENSI 
0 l.HciJSKi-l 


IMACHIPI) 

I SPIS  (2’  » 

! .'cri  ( .36) 

I ALTI2?) 
STATtHf.MT  EO!l 


/r.CELtPOMFTfp.  CATA 


DIMS  NS  I IN  I ACCI2J) 


JIMENSIO'J  SIATEMENf  FOR  ANGLE  OF  ATTACK 
DIMENSUiN  lA)A(r.>) 


CATA  0«.\G/C./t  THfcUST/C./ 

DATA  ISPr.S  /•  0 ICO*,*  200*,*  300', • 400*,*  500*,*  600*, 

* 7Jv.*,*  Ht:*,*  400*  ,*100C*  ,*U00*  ,*1.2v)0*,*13CO*, *1400*, 

* >3  jO* , *1(  0)*  , *I.7CC*  ,*1CD3*  ,*1700*,  *2COO*/ 


DATA 

IMACH/*  0.0*,*  0. 

1*,*  0.2*,*  0.3*,*  0.4*,*  0.5*,*  0.6*, 

* 0. ;*, * O.F  * ,* 

0.9*,*  1.0*,*  l.I*,*  1.2*,*  1.3*, 

2 

DATA 

* 1.4*,  * 1.5*  ,* 

KkPM/D/,  NPPH/O/ 

1.6*,*  1.7*,*  J.B*,*  1.9*,*  2.0*/ 

, IFLIP/1/,  INCR/1/ 

DATA 

RADIUS/44.0/ 

DATA 

K JUNT/l/ 

DATA 

CL0/C.1/,C  LSLU/2 

.5/,  AREA/202./,  WEIGHT/17000./ 

DATA 

V2L/U0D.  / 

data 

IBET/1/ 

DATA  MAXG/15.0/ 

DATA  M1NG/-3.0/ 

FOLLJKINS  DATA  IS  FOP.  GliNERATING  A TAPF 
IVP?  DISPLAY  PFPPESI  (4TI  NO  AN  ALTIMETER 
WITH  A SCALE  IN  INCR'-MENTS  OF  IDO 

DATA  lALT/*  ?0.  * , • ICO*,*  0 *, 


00001490 
00001500 
00001510 
000C1520 
00001 530 
0000) 540 
00001550 
00001560 
00001570 
C0001580 
CC001590 
00001600 
00001610 
00001620 
00001630 
00001640 
00001650 
00001660 
00001670 
00001680 
00001690 
OQ001700 
OCG01710 
00001720 
00001730 
00001740 
0C001750 
00001760 
00001770 
00001780 
00001790 
00001  BOO 
000C1810 
00001820 
00001830 
00001840 
00001 8 50T 
0CC01860 
00001870 
000018B0 
00001890 
C0001900 
0C001910' 
00001920 
0C001930 
00001940 
OC001950 
00001960 


uuuuo  u'-’ui  ouuiuououu 


LEV5L  20 

* 

) 

2 


aDCUMP 


0(TF.  = 7A275 


i6/n/i3 


• S/Jfj*,»  700*. • 603*, • 500', • AOO*.'  300', 

• 200',*  C *,•  900','  SCO*,*  73'0*,'  630*, • SOC't 

‘ -iOO*,*  300', • 2C0*.'  JOG*,*  0 •/ 


FOLLOWING  OarA  IS  FOP  GENFRATING  \ TAPE 
TYPE  DISPLAY  RF.  PP  ES  F NT  I NG  AN  ALTIMETER 
WITH  a SCALE  IN  INCREMENTS  OF  TOGO 


0C00197G 

OCOO19F0 

30CC1990 

OC002000 

OOOC201O 

0C0C2C20 

CC002030 

CCCC2040 


OA  TA 

lALTT/*  120','  TT9','  IIB* 

f*  LIT, 

• 116' 

,*  315', *114*, 

000C2O5C 

*. 

U • ’ i.  2 ' . ■ ill 

1.1  O' 

109* , • 

138'  , • 

107*, • 1G6*, 

00002060 

7 

i 05  • , • 13A*  , • '33 

1.12', • 

101  *,  • 

100'  , • 

99*,'  98*, 

00002070 

? 

P7>,'  9F','  95 

94', • 

93  • , • 

92*  . • 

91*, • 90*, 

0 C*  0 0 ^ 0 P c 

*; 

b-)*,'  bb*,*  87 

96', • 

85  • , • 

84'  ,• 

83*, • 82*. 

000C209C 

c 

81  • , • T ■ • t • 79 

78', ■ 

77',' 

76*  , ■ 

75*, • 74*, 

00002100 

r 

73‘,‘  72', ‘ 7T 

70', • 

69*  , • 

63*  , • 

67*,'  66', 

00002110 

f 

6 3 • » * o-V  • f * 63 

62'f* 

61  • , • 

60* 

59*, • 56*, 

G0002V2C 

7 

57'  , • 3b'  55 

54', • 

53  • , • 

52' 

51', • 50', 

000021 3C 

3 

49* , ■ A?' , • 47 

46',' 

45* 

44«  , • 

43*, • 42*, 

000021^0 

9 

41', • 43','  39 

38', ■ 

37* 

36' 

35*, * 34*, 

30002150 

A 

33','  32',*  31 

30', • 

29'  , • 

28*  ,• 

27*,*  26*. 

00002160 

e 

25','  44', • 23 

22*, • 

21',' 

20* 

19’,*  16*, 

0000217C 

C 

17','  16','  15 

J4',' 

13'  ,• 

12* 

11', • 10*, 

COC0218C 

D 

9 • , • 3 ' 7 

• 6 

5 

4 *,* 

3 2 *, 

00002190 

E 

1 • , • 3 • -1 

-2 

-3 

-4  *,* 

-5  *,'  -6  *, 

000O22C0 

F 

-7  ■ , • -8  • -9 

• ,'-13  • 

-1 ) • , • - 

12  *,* 

-13  • , '-14  • , 

00002210 

G 

-15  •/ 

OO0C222O 

OOOC223C 

ACCELEROMETER  3ATA  STATEMENT 

000022^0 

00002250 

DATA 

lACC/'  15  *,•  14 

• 13  •, 

• 12  't* 

11  *. 

• 10  • ,*  9 

00002260 

J 

* 8 • , • 7 • , • 

e • 5 

• , • 4 • 

3 

*.*  2 *,*  1 *, 

OOOC2270 

2 

• 0 • , • -1  • ,* 

-2  't*  -3 

-4  . 

f*  -5 

*, • -6  •/ 

00002260 

00002290 

DATA 

STATEMENT  FOR  ANGLE  OF  ATTACK 

00002 300 

0000231C 

DATA 

lAOA/'  45  40 

• t*  35 

' 30  • t • 

25  *, 

• 20  *t*  15  *, 

0C00232C 

7 

• 1 3 • , • 5 • , • 

C -5 

•t'-lO  • 

,'-15 

*,*-20  ',*-25  •/ 

00002330 

00002340 

COMPUTE  VOLTS  FROM  ANALOG  INPUT  *» 

0C002350 

00002360 

000C237C 

FOLLOWING  DATA  STATtMENT  IS  FOR 

USE  IN  SCALING 

OOOC2380 

THE 

XY  COORJI NATES  OF 

ARTIFICIAL 

HORIZON 

0000239C 

DATA 

AHM5  /-6.J/ 

000G?'50C 

0000241 C 

VOLTS  = INALINIT ) 

VOLTS  = volts  « 5.0  / 3276F. 


0COC2 A?c 
03002A5C 
0P3C2AAC 


A-18 


3 LFV6L 

20  AOCCHP  date  = 74275 

16/11/33 

C *♦  COMPUTE  ROLL  RATE  ♦♦ 

00002450 

C 

00002460 

CC 

RCLRAT  = ( VOLTS  - C.ALV  1 * CALO 

0C0P2470  ’ 

CC 

BANKN  = 8ANKU  + ( HOLPAT  <■  FR7IME  ) 

00002480 

CC 

IF  ( FANKN  .01.  180.0)  GO  TO  4-3 

00002490 

CC 

IF  ( 8ANKM  .GT.  75.0  ) CC  TO  <50 

0CC0250C 

CC 

GO  TU  6) 

00CC2510  1 

CC  43 

IF  ( 8ANKN  .LT.  785.  ) GO  TO  45 

00002520  j| 

CC 

GO  TG  60 

300C2530  1 

CC  4 5 

EANKN  = 285. 

000C2540  1 

CC 

GO  TO  b) 

00002550  1 

CC  5 0 

3ANKN  = 75.0 

0C00256C  : 

: CC  f j 

CCNTINUE 

QC  002  5 70 

1 c 

00002580 

C***«>f'  COMPUTE 

0CC02590  ^ 

00002o00  ; 

1 CC 

RANKN  = AMQ,(  8ANKN , 360. ) 

CC00261C  1 

c 

OCC02620  1 

. CC 

IF  ( BAOK'n;  I 51,7.3,70 

C0002630  , 

' CC  cl 

HANKN  = BAN<N  + 360. 

30002640 

1 CC  70 

CONT INUE 

0P002650 

CC 

BANKO  = BANKN 

0C002660  ! 

' c 

OC002670  j 

, COMPUTE  ARTIFICIAL  HORIZON  »#*♦»♦**** 

OC002680 

■ C. 

00002690  1 

\ 

GO  TO  ( 30,  82  ),  KLiUNT 

00002700 

' c 

OC002710 

, 83 

KCUNT  = 2 

00002720 

C 

DC  81  I =1,5 

0GC02730 

00002740 

! 

DEL  = I 

00002750 

OFLTAd  ) = OEL  * C0NST2 

0CC02760 

1 

COEL  <I ) = COSIDE  LTA( I ) ) 

0C002770 

1 

SDELII)  = SINIOELTAIin 

00002780 

1 

00002790 

82 

CONTI-NUE 

C0002800 

C 

COMPOTE  ALPHA 

00002810 

DT  = FRTIME 

00002820 

ALFAR8  = INALINI4) 

00002830 

IF  I ABSIALFAR8)  . LT.IOO.)  ALFAR3  =0.0 

00002840 

1 

ALFaRS  = (ALFAR8/16384.0)  *ALFARX 

00002850 

GLOAD  = LIFT/8EIGHT 

00002860 

IF  I GL3A3.lt. l.-O)  GO  TP  1015 

00002870 

ALFAR8  =ALFAR.3-  ( GL'IAD-J  . .3  ) *ALF  Aft  X/MAKG 

00002880 

GO  TO  1316 

' ■ 0C002890 

1 01  5 

ALFA63  =ALr\<i8+  (GL)AD-'.O)  *ALF  AP  X/ ( M ING*5 . 0 1 

00002900 

1 1 CIS 

CO.ITINU- 

0'OC2910 

i 

alpha  = ALPHA  ♦ ALFAR8  F DT 

00002920 

A-19 


o o n r>! 


LEVEL  20 


ADCOMO 


DATE  = 7A275 


16/11/33 


•.  . ,1 

1 


C 

IE  (ALPHA  .LT.  -0.2)  ALPHA=-0.2 

RHO  = GAMMA 

FBFT=0. 

IF  ( IbET.LT.  0)  FhET=l. 

BciTAR-l  = I(^iALI^4(t) 

IF  ( APS(«ETAP8)  . LT.1.30.)  BETAR3  =0.0 
BETARO  = ( HrTAR;.i/5276F.0)*BETPMX 
BETA  = beta  + BETAPR  * LT  + FBET  v PI 
C 
C 

0 = F.HG  * r .wsj 
A = SKM(BPTA) 

B = C )S(BET.\) 

X = C » A 
Y = -0  « B 

X X ( 1 ) = X - I i . 0 * B 

_ YY(?  ) = Y - IB.r,  * A _ _ 

XX(2)  = X"  + 13.0  * B 

YY(2)  = Y *■  13.0  * A 

C 

C 

XX(3)  = X 

YY(3)  = _Y  

C 

K = 3 

XX(A)  = X -t. 0 » ( B « COEL(K)  - A * SOEL(K)) 

YY(A)  = Y -6.0  * ( A * CDEL(K)  + B * SOEL(K)) 

C 

DO  99  I_^  

C 

XX(I)  = t(xxm  - AHM6)  * 1300.  / 12.  ) + 1375. 
C 

YY(I)  = ((YY(I)  - AHM6)  * 1300. _/  12.)  + 2350. 

C " 

99  CONTINUE 


*♦  COMPUTE  HEAD  RATE 

MASS  =-;iEIGHT  / G" 

PHI  = -beta  

SINPHI=  SIN  (PHI ) 

COSPHI  = CCS  (PHI) 

THETA  = RHO 
C COMPUTE  ATMISPHF.R'" 

ALT  = / 

U (Z  .3E.  55330)  GO  TC  1010 


00002930 
00002930 
00002950 
00002960 
00002970 
00002960 
00002990 
0C00300O 
00003010 
0000302C 
00003330 
0COO3  3A': 

3?035053 

OC/003j6C 

00003070 

00003080 

00003090 

C0003100 

00003110 

00003120 

00003130 

00003140 

0C003150 

C0C031F0 

00C03170 

00003160 

0000319C 

00003200 

00003210 

0000322C 

00003230 

00003240 

00003250 

C00C3P6C 

00003270 

00003280 

CC003290 

000C3300 

00003310 

00003320 

0C00333C 

00003340 

0600?35C 

CC003360 

00003370 

00003380 

00003390 

OEOCIAOD 


G LEVFL  2-'^ 


ADCL.MP 


DATE  = 7AZ75 


16/1) /33 


TEMP  = 59.  J - ■Z.nOSFT  ♦ ALT 
nUMi  = 1.0  - ^.00357  / EJ8.A  » ALT 
PRES  = ?116.0  » DUMl  5.2S6 
OENS  = T.COTSTe  * OMMI  t*  4.2S6 
G I TO  1020 
temp  = -67. ) 

00M2  = (ALT  - i63,-.:.ri  / ?093'l. 

PEES  = 480. -50  t XP  (-'.'UM2) 

OlNS  = PMES  / 673946.0 

SO'JNC  = SCM  (PCrS  ♦ 1.4E6  / DENS! 

PACK  = VEL  / SOUNO  »1C0. 

0 = O.p  * 'JEMS  6 VEl  «•  2 
C'JPPUTE  FL'RCES 

CL  = CL.)  + CLSLO  5 aLPH/ 

CD=  CL*«2 

OP  A'»  — JpC  0^”  area 
If  (ALPHA.LT.O.  VI  Gf.  TO  I 038 
CL='  . ) -(ALPHA-:. 4)<:2. 

IE (ALPHA.lt. 0.6)  GO  TO  '038 
CL  = ). 

ALPHA  = 0.6 

IF  ( VEL. LT.no. 0)  ALPHA=: 

CTMTINUE 

IR( VEL.lt. l.O)  VFL=1.0  _ 

FALT  = 1.130,,.  - 0.25  * ALT’" 

FMACH=  2)27.0  + C.J72  * ALT  - 0.  P0'0003 1 ''ALT*  I 
TH'TOT  = INALIHIZ) 

THSOT  = t THEUT  ♦ CALV  ) / 32768.  * CALO 
TN'AX  = FMACH*  F L Oi  T ( MACH  »/ 100.  + FALT 
TMAX  = T.MAX“.2.0  

1 F ( I S9T.3.E0.0)  TMAX  = TMAX/4.0 ' 

TH'-«UST  = THHCTV  TMAX  _ 

LIFT  = 0 * CL  * AREA 

LnT  = lift  + THRUST  * SIN  (ALPHA) 

THRUST  = thrust  * COS  (ALPHA) 

DYNAMICS  _ ^ ^ 

■'MV'  = MASS  * V'-L 

VELDT  = (THRUST  - DRAG  - HEIGHT  * SINGAM)  / ! 
PSIOT  = (LIFT  * SINPHI)  / («V  * COSGAM) 

GAMUT  = (LIFT  * CCSPHl  - WEIGHT  * CDSGAM)  / 1 
VEL  = V-LDT  ” DT  > VEL 


PSI  = PSIDT  * OT  + PS 

GAMMA  = GAMOT  * OT  > 

IF  ( IbET.LT.'O)  I BET  = 1 

IF  ( ABS(GA"MA)  . LT 

I8=T  = -IBcT 

PSI  = PSI+  PI 

IE  ( GAMMA  . LT  . 0. 


PSI 

+ GAMMA 


PI  2 ) GO  TO  1040 


) GO  TO  1035 


0C0034JC 
00003420 
00003430 
0C003440 
0000345C 
0000346C 
0000347C 
000C3480 
00003490  ' 
00003500  ‘ 
0C00351C  J 
00003520  j 
OC003530  I 
00003540 
0C00355C  1 
0000356C  ■; 
0C00357C 
GOOOBSeC  I 
00003590  j 
000036C0  J 
00003610  ) 
00003620  ♦ 
00003630  i 
00003640  J 
00003650  1 
00003660  j 
00003670  i 
00003680  I 
000C369C  i 
0O0037C0  j 
0000271C  5 
C000372C  i 
00003730  I 
0000374C  5 
00003750  j 
00003760  • 
000C377C 
0000378C 
*00003790 
00003800 
00005 810 
00003820  I 
0000383C  t 
0000384C  ( 
00003850  ’ 
0000386C  ! 
0CCC3670  ' 
030C38F:  : 


n o r»  nl  r>  , o'nn  ono  n o o 


ADCOMP 


DATE  = 74275 


16/11/33 


GAKMA  = PI  - gamma 
GO  TO  1040 

1035  gamma  = -pi  - gamma 
1040  CONTINUE 

SINGAM  = SIN  (GAMMA) 

COSGAM  = COS  (GAMMA) 

OELX  = VEL  * COSGAM  * COS*(PSI)  * OT 
CELT  = VEL  COSGAM  + SIN  (PSD  * DT 
GEL/  = VEL  +SINGAM  # OT 
APX  = APX  + OELX 
APT  = APY  + Duly 

/ = Z + DEL/  

ALT  ^ / 

VVEL  = OELZ  / DT 
XVFL  = OELX  / OT 
YVEL  = OELY  / DT 
GOSPO=VEL  *0.59? 

KGLGD  = LIFT  / WFIGHT_*  130. 

TRGHDN  = PSI 

GAMMAO  =_GAMMA  * 57.?96 

**  COMPUTE  COSINE  OF  TRGHDN  *♦ 

CTRGHJ  = COS  ( TRGHDN  .) 

**  COMPUTE  SINE  OF  TRGHDN  **  _ 

STRGHO  = SIN  ( TRGHDN  ) 

...COMPUTE  compass  point  ***  _ 


ZZ  = 90.  / 57.2956 
TRIG2  = 2.  * ZZ  - TRGHDN 

COMPX  = (((39.9  * C0S(TRIG2_;:^  100.  / 57.2956))  - UN1)_*  XN21  / 

I UN2). ) ♦ XNl 

COMPY  = (((39.9  * SIN  (TRIG_2  - 103.  / 57.2956))  - VN1)_*  YN21  / 

1 VN21)  ♦ YNl 

00  90  LPP  =1,7,2  ~ 

CX(LP?)  = (((RADIUS  * COS(TRIG2))  - UNI)  ♦ XN21  / UN21)  ♦ XNl  -56 
CX(LPP+1)  = (((RADIUS  ♦ SIN(TRIG2))  - VNl)  * YN21  / VN21)'+  YNl 
93  TRIG2  = AMODUTRIG?  - ZZ),  6.2A32) 


**  GET  NEW  POSITION  OF  XAC  AND  YAC 


XAC  = APX  / 6J6;. 


00003R9C 
OC003900 
OOC03910 
00003920 
OOOC393C 
C000394C 
00003950 
00003960 
00003970 
00003980 
CG00399G 
0000*000 
0C00*01.C 
00004C2G 
00004030 
C00040*0 
0000*050 
0CC0406C 
3000*070 
0C004080 
00004C90 
000041  CO 
00004110 
0000*120 
00004130 
00004140 
00004150 
0C0042  60 
00004170 
00004180 
000041 90 
00004200 
0000*250 
00004220 
00004230 
00004 240 
00004250 
00004260 
OOijf'4270 
.00004280 
0000*290 
00004300 
00004310 
OOCC4320 
30PC4330 
0('0C43*C 
0000*350 
00034  56C 


A-22 


LtVfL  20 


AOCOf'P 


OATE  = 7A275 
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VAC  = APY  / 6CB0. 


I K = 1 

I ITCNT  = 0 

|C 

I CTLCGP  = ICTLP 

' IF  ( ITCT  .to.  0)  GC  TO  ^'75 

j no  joi  1=  1,1  rcT 

I IF  ( CT1.COP  r.  TOFim  go  to  3 00 

IF  ( CTLOGP  ,LT.  TfifM  I)  ) GO  TO  A7b 
C 

C*’--  COMPOTF  A IJT  AN.'  VT  AND  CHTCK  IF  ♦I' 

c*’'  Turv  AO-  within  si/FI  units  *» 

G I = TXI  I ) - XAC 
VT  = Tvm  - VAC 

c 

IF  (A35IUT)  - SI/FT)  100,  1?0,  300 
C 

I.I^  (AOSIVTI  - SIZFT)  li,,,  I'O,  30T 
113  CONTINUE 

C**  GrNFP-AT'j  1 DX  ANO  OY  AND  CONVERT  w* 

C**  TJ  RASTER  UNITS  »* 

C _ 

XS  = <-1.)  * VT  * CTKGHD  + UT  * STRGHD 

YS  = VT  • STRGHC  + UT  * CTRGHP 

C 

IF  (AdS(XS)  - SIZETn2S,125,30Q 
C 

1?5  IF  (AHS(YS)  - SI  ZETH  35,135,300 
135  CONTINUE  ■■ 

C 

C**  CU.NVFRT  T.l  RASTER  UNITS 
C 

IDTXIIO  = ((  XS  - Ul)  * X21  / U21  ) + XI 

_IOTY(K»  = ((  YS  - VI)  * Y2l  / V21  ) + Y1 

c ■ ■■  - - 

ir.TYPE  (X)  = I TYPE!  I ) 

ICTChAIK)  = ICHA  R( I ) 

K = K + 1 

ITCNT  = ITCNT  + ) -- 

333  CONTINUE  _ 

c ‘ ■ ■■  ■■■ 

C**  compute  X AND  Y NAVIGATIONAL  POSITIONS  ** 

C 

A75  CONTINUE 
N = 1 
L = 1 


OC004'>70 
33004380 
O: 0043 90 
00004400 
OC004410 
00442  C 
COC04430 
Q0004440 
00004450 
OOOC4463 
00004^70 
C03044PO 
•3C;C4490 
0000A530 
OF  004  5 1.0 
00004520 
60004*^33 
36004540 
0C30455C 
OOJCA-560 
CC004570 
00004580 
00004590 
0C304600 
■030:4610 
OOOC4620 
00004630 
000Q4640 
0O00465C 
00004660 
00004670 
•3C00468C 
•:cno46°o 
OC004700 
00004710 
00004720 
OG00473C 
00004740 
30004750 
00004760 
00004770 
OC004780 
OC004790 
C00048CO 
00004810 
C00C4820 
00004830 
C3C04840 


LEVEL  20  ADCOMP 

DATE  = 

74275 

16/11/33 

INCNT  = 0 

IF  ( INCT  -Eg.  01  GO  TO  560 

00004850 

00004860 

C 

.500  CONTINUE 

OC004870 

00004880 

C 

C**  COMPUTE  A UN  ANJ  VN  AND  CHECK  IF  «♦ 

00004890 

00004900 

C**  they  ape  within  SI2EN  LIMITS  ** 

c 

00004010 

00004920 

I1.*a1  = MX(N)  - XAC 
VN  = NYtN)  - YAC 

00004930 

00004940 

c 

IF  (ASSIUNl  ~ SIZEM  52'^t  520,  550 

00004950 

00004960 

C 

520  IF  (AaSIVNI  - SIZIM  5 3l> , 530,  550 

00004970 

C000498C 

C 

530  CONTINUE 

00004990 

00005000 

C*«  GtNE.PATE  A CNX  AND  CNY  AND  CONVERT 
C**  TO  RASTER  UNITS  f* 

00005010 

00005020 

C 

XNS  = (-1.)  « VN  * CTRGHD  + UN  ♦ STRGHD 

0C005030 

00005040 

YNS  = VN  * STRGHD  + UN  4 CTRGHD 

IF  lABSIXNSI  - SIZEN  ) 535,  535,  550 

00005050 

00005060 

C 

535  IF  (A3SIYNSI  - SIZEN  ) 540,  540,  550 

00005070 

0C005O80 

C 

540  CONTINUE 

00005090 

0C0C51C0 

C 

C**  CONVERT  TO  RASTER  UNITS  ** 

00005110 

00005120 

C 

lONX(L)  = ((  XNS  - UN1I+  XN21  / UN21 

) ♦ 

XNi 

0C005130 

0C005140 

lO.NY(L)  = ((  YNS  - VNll*  YN21  / VN21 
INCTYPIL)  = NCTY(N) 

) + 

YNl 

00005150 

00005160 

L = L ♦ 1 

INCNT  = INCNT  + 1 

00005170 

00005180 

550  CONTINUE 
N = N ♦ 1 

00005190 

C0005200 

C 

C«*  CHECK  IF  IN)  IS  LESS  THAN  INCT  ( INCT 

= NO 

. OF 

NAVG.  PTS  I 

00005210 
♦*  00005220 

c 

IF  I N -LE-  INCT  ) GO  TC  500 

00005230 

C00C5240 

c 

:i'"'SET  U^THb  "^REACTION' TESTS 'IF"  THrRE~Af<'E  ANY  TO'SET  UP  > 

i(s^  if  :fc  « i(- % 4>4=4(«  4(:4<4e«  * 4:  **  4c:6  * 

560  “CUNT  INUE' 

IF  (IBCl  -EO.  il  GO  TO  660  

IF  (IHOTSW  .EQ.  01  GO  TO  BOO  ' ' 

NEWT IM  = ICTLP 


00005250 

00005260 

0C005270 

000C5280 

000C5290 

00005300 

00005310 

00005320 
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r 
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ADCf'MH 


DATE  = 7A375 


16/11/33 


IBCl  = 1 
IBC2  = 3 

OfCODE  THE  MAHEUVEE  NO. 

DGP  = DIG1N.(3)  - 1.03  A 
M = C 

IF  (Cr,H  .FQ.  01  GO  TO  5C0 
M = 1 
J = 2 

on  073  L = lf-3 
If  (OGP  .EO.  J1  Gr  TFl  6ET 
J = J 
M = M + 1 
57.)  CONTINUE 
M = C 
GO  TO  630 

_5EC  P = M «■  10 

DGP  = DIGINi (4) 

IF  (CGP  .GE.  1024)  OGP  = OGP  - 1024 
N = C 

IF  (DGP  .EO.  C)  G(j  TO  600 
N = 1 
_ J = 2 

DO  5<53  L = 1 f 9 

IF  (DGP  .EO.  J)  GO  TO  6CC 

J = J * 3 

' ■■  ■ N = N X ' 

593  CONT  INUE  _ _ 

M = C 

GC  TO  620  

600  1 = f'_*  N_  

t?.0  IF  (M  .NE.  0)  GO  TO  630 

FALL  THRU  HFRE  FOR  INVALID  MANEUVER  NO. 

625  IBCl  = 0 

Gli  TO  833 

630  CONTINUE 

IF  (IMS'^O(P)  .^C.  01  GO  TO  625 
ISLwNC  = I MSEO(M) 

1 SEUCT  = IC'.'TAbl  ISFCNC) 


•I'-y 

5'  . ' ’^’4 


to 

iiS 


AND  IGNORE  THIS  MANEUVER 


00005330 
0C005340 
GC005350 
00CC5360 
C0C05370 
00005380 
00005390 
0C0C5400 
00005410 
CC005420 
00005430 
00005440 
00005450 
0.00054  6C 
GC005470 
0C005480 
00005490 
0C005500 
00005510 
00005520 
00005530 
00005540 
0CC05550 
00G05560 
00005570 
00005530 
00005590 
00005600 
000G5610 
00005620 
000C5630 
00005640 
00005650 
000C5660 
0C005670 
00005680 
00005690 
C0005700 
00005710 
OOC0572O 
00005730 
30005740 
00005750 
00005760 
000C5770 
00005780 
000C5790 
000C58CC 
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o oio  o onn  o oor» 


LEVEL 
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DATE  = 74275 


I6/U/33 


C 

C 


C 


IPTK  = rSEONC  + 1 


b‘tO  IF  (IUC2  .Ew.  i)  GO  TO  fiOT 

FAIL  thru  here  TI  check  FCF  A NEW  CHARACTER  TO  BE  DISPLAYED. 

I FULL  = ICMTABI I PTR ) 

IG'JTIH  = IHAF(l)  + NFWTIM 
IF  (ICTLP  .LT.  IGDTIM)  GO  TO  600 
NCSW  = i 

ICARFG  = 1 

liND  = ICTLP  50 
CHAR  (I  I = 1HAF(?) 

GC  TO  b:o 


660  IF  ( IHOTSw  .EU.  1)  GO  TO  670 

IBCl  = ) _ 

IRESET  = 3 

_ CHARI;)  = BLANK  _ __  

ISTART  = 0 

ICARFG_=  0 

GO  TO  800 

673  IF  (ICARFG  .£«.  0)  GO  TO  640  ~ ” 

IF  I ISTART  ,EQ.  "^I  GO  TO  680  

IF  I ICTLP  -LT.  lEND)  GC  TO  900 

‘fALL^  thru  HER'E  if  Su'tijECT"FA~rLED  TO  respond  TTO  A CHARACTER. 

CHAR  ID  BLANK  ’ 

ISTART  = 0 _ 


SEf'up'NEXt  CHARACTER  IN  THE  "MEMORY  SET 

683  ICARFG  = 0 
IRESET  = I 
ISEQCT  = ISEOCT  - 1 

IF  IISEOCT  jGT.  0)  GO  TO  690 

I6C2  = i ‘ 

GO  TO  800 

690  IPTR  = IPTR  + 1 
IBC2  = 0 
GO  TO  640 


0000581 0 
CC0G5820 
0C00583C 
0C0G564C 
00005650 
OC0O566O 
0O0C5870 
00005680 
OOOC5690 
00005900 
00005910 
0000592C 
00005930 
3ROC5940 
00005950 
3~005960 
30005970 
00005960 
00CC599C 
00006000 
30006010 
00006020 
00006030 
00006040 
OOOC6050 
OC006060 
0000607C 
00006080 
0C006090 
000C61C0 
00006110 
00006120 
000C613C 
0C0C6140 
00006150 
00006160 
CJC0617C 
00006180 
C000619C 
0C00620C 
00006 21C 
OC 006 2 20 
CC00623C 
0C006240 
000062 5 G 
OOCC6260 
000062 7C 
00006280 


ooo«^o  Ci  r>r>r)oo 


LEVEL  20 


AOCOMP 


DATE  = 7A275 


16/U/33 


607  CONTINUE 

CHECK  IF  CATEuDKY  3 SWITCH  1 S ON  . 

IF  SWITCH  IS  ON  THAN  CCNFUTF  DATA 
NECFSSAPY  TO  GENERATE  DISPLAY 

IF  ( IS«TC3  .no.  0 .AND.  ISWTC2  .EO.  0 ) GO  TO  850 


ISWTC3  = 0 
ISWTC2  = 0 
RPMi=  THRGTvIjO. 
rpM2=  FP!-n 


r ■ 


0CG06290 
C00063C0 
0000631C 
00006320 
0C006330 
00006260 
00006550 
00006360 
OOCf-63  7C 
O0CC6560 
00006290 
cor)06‘‘CO 
00006tJC 


rpm:. 

650 

/ 

1 cc 

+ 

8 50 

/ 

00006 620 

RPM2 

>}: 

65  J 

/ 

100 

■f 

8 50 

J 

0C006630 

> 

00006660 

rpm;. 

* 

7 00 

/ 

10.-. 

+ 

6 50 

> 

C00C665C 

RPM2 

700 

/ 

100 

+ 

650_ 

/ 

00006663 

RESCALE  HACH  VALUES  TO  RASTER  UNITS  ** 


OCOCb^Tv 

00006660 

00006-^90 

OCC06500 

0C00651G 


850 


' MACHKYdl  ='0 

. _ 

C000653C 

M = 1 

. ^ 

CD006560 

RASM  = 3820.3  * VE L / 

SCUNO  + 2925. 

00006550 

IRASM  = RASM 

0000656C 

c 

DO  F7C  N = 1,21 

0OC0657O 

0000658C 

c 

IF  ( IRASM  .GT.  HIUP. 

.OP.  IRASM  .LT. 

LOUR  ) GO  TO  860 

0000659C 

0000660C 

c 

HACHTX(.M)  = I.MACH(N) 

00006610 

0C00662G 

MACHXY(M+1)  = IRASM 

0C006630 

MACHXY(l)  = MACHXY(l) 

+ J 

00006660 

860 


670 


90  7 


IRASM  = IRASM 
CONTINUE 


383 


CONTINUE  ■ . 

lASm  = 0 
K = 1 

SPEEDK  = onspo 

RAST  = SPEEOK  * 2.87  + ;925. 
IRAS  = PAST 


00006660 
00006670 
00006680 
00006690 
00006 70C 
OCOC671 0 
00006720 
00006730 
00006760 
00006750 
C0006T60 
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G LEVEL  20 


AiOCCKP 


0;:TE  = 74275  16/11  /i3 


C 

00  SIO  1 = 1,21 

c 

IF  ( IKAS  .GT.  HIUH  .or.  IRftS  .LT.  LfUM  GO  TO  905 
C 

ISIftS(K)  = ISPDSU  ) 

IAS(K+1)  = [RAS 
lAStl)  = lAS(l)  + 1 
K = K + i 
C 

905  ISAS  = IRAS  - 2H7 

C _ ___ 

910  CCNT  INUE 
C 

=<•*>*;  + * + + + if- **Jt!*,X 

COMPUTE  Y FO-.  VERTICAL  VfLOCITY  AND  CONVERT  TO  RASTER  UNITS  ** 

«**.•?:  JS  ^ rt  ^ijr*  * y.  «,/».•*«  'k*«  ip*  H's*’  ♦'>:  *’3«>!sV  *>■<#  * ♦ir  ^ 


VRAST  = VVEL  » 13.8  + 2925. 

IVOUM  = VVEL  * .6 
IVRAST  = VRAST 

IF  I IVRAST  .GT.  3385  ) GO  TO  925 
'IF  T'i  VRAST  . LT.'  2*'65' T“G0  TO  <T30 
GO  TO  950  ■ 


00006770 

0v')0C6780 

00006790 

00006800 

0000681C 

00006820 

00006830 

00006840 

00006850 

00006660 

OOOC6870 

00006880 

00006690 

0000690C 

0000691C 

00006920 

OC006930 

CC0C6940 

O0CO695O 

00006960 

00006070 

00C0698C 

00006990 

0C0O7000 

00007010 

000C7020 

00007030 


975  IVRAST  = 

GO  TO  950 

930  I VsTasT'^  2 4^64 


950  CONTriUE 
_ KMACH  = TMAX/10.  _ 

KALT  = ALT  

KALF_  = OALF 

KVV  =' ALPFIAnSOO/PI 

KCAM  = gamma  # 57.3 

KGAM  = (THRUST-DRAG) /id'. 

ISPO  = GOSPD 

KXAC  = XAC 

KYAC  = YAC 


PESCALE  ATLIMETER  Y VALUES  TO  PASTFR  UMTS  FDR  lOOC  SCALE 
lALTXY(l)  = 3 


A-28 


00007040 
0CC07050 
OCC0706C 
00007070  ! 

00007C80  i 
0000709C  ' 

00OC710C' 
00007110  : 

00007120 
OOC07130  1 

0000714C  I 
00007150  ! 

00007160  , 

OCC07170 
00007180 
0C00719C  ’ 

00007200 
00007210 


o«^ono,  on'  orjr^no 


L6VFL  20 


AOCLMP 


PATE 


7A275 


16/11/33 


IF  ( ABSIALl 1 -IT.  3 . ) ALT  = 1. 

C 

C 

C-  272F5  = 230  * 121  - 575 
C 121  REPKiiSF:M7S  THE  NUMBER  OF  ENTRIES 
C TO  ENTRY  NUMiER  0 . 23C 

C REPRESENTS  2>J  RASTER  UNITS  BETiVTEN 

C '^ACH  ENTRY  ON  THE  DISPLAY  • 

C 575  IS  THE  NUMBER  OF  RASTER  UNITS  TO  THE 

C EENTER  OF  TH.  DISPLAY  . THE  DISPLAY 

C IS  :il50  TASTER  UNITS  LGNf  IN  THE  Y COOPD. 

C _ 

IF  (ALT  ,GT.  r/MOC.)  AIT  = 120003. 

If  (ALT  ,LT.  -LEODO.)  ALT  = -15000. 

RALT  = -(ALT  / 10C.O.  ) * 230  . + 27255. 
lALTA  = RALT  / 23P.O 

35'".  REPRESENTS  THE  HIGHEST  RASTER 
UNIT  US-0  IN  THF  DISPLAY  . THE  Y COQRO. 
GOES  FROM  2350  PO  TO  35CO  RU  ( 1150  RU,S  ) 

DIFF  = RALT  - ( lALTA  « 230  1 + 3500. 

JNDX  = I ALTA  + 1 
niFr  = OlFF  - 230. 


DO  1350  J = 1,5 

lALTXMU)  = lALTKJNOXl 
IALTXY( J+3 ) = DIFF 

IF  I IALTXYU  + I)  .LT.  LCUR  1 GO  Tn_U51 
DIFF ■ = DIFF  - 230.  ' 
lALTXY(i)  = lALTXY(l)  + 1 
JNDX  = JNOX  + 1 

IF  ( JIOX  .GT.  136  ) GO  TO  1151 

1150  CONTINUE 

1151  CONTINUE 


RESCALE  ALTIMETER  Y VALUES  TO  RASTER  UNITS  FOR  100_S£ALE 

lALHXYU  ) = 0 

"IF  ( ABS(ALf)  .LT.  1.)  ALT  =1.  ~ 

C 

IDUMl  = ALT  / 1000. 

ALT’Oj  = ALT  -(  ICO'..  < float  ( lOUMl  )) 

ALT)  CO  = ALT1  '•  i / TOO. 

C 


00007250 
CLC.C7260 
00007270 
OC007280 
CC007290 
00007300 
CC007310 
00007320 
00007330 
CC0073A0 
OOOC7350 
C00C7360 
OOOC7370 
050C7380 
0 0007 3 90 
00007A00 
000C7A1C 
00007A20 
00007430 
00007440 
00007450 
00007460 
0T007470 
C0C07480 
00007490 
00007500 
00007510 
00007 520 
0C007530 
00007540 
00007550 
00007560 
00007570 
00007580 
00007590 
00007600 
00007610 
00007620 
00007630 
00007640 
0C007650 
00007660 
00(307670 
00(307680 
00C0769C 
00007700 
0C0C7710 
00007720 


oooor>o  oooooo  • r>  o o o nnono  r»onr>o<^.  noon 


Lfc  VtL 


20 


ADCOMP 


OATP  = 74275 


16/13/33 


2A15  = 230  » 13  - 575 
13  SEPR'^StNTS  THE  NUMBER  UF  ENTRIES 
TO  -NTRY  CONTAINING  THE  2N0  2ERO  . 

230  KEPaeSFNTS  230  RASTER  UNITS  BETWEEN 
EACH  entry  on  the  n splay  . 

575  IS  THE  NUMU.R  CF  RASTER  UNITS  TO  THE 
CPNTFR  OF  THS  IISPLAY  . THE  OISPLAY 
IS  U5.;  raster  units  long  in  the  y coord. 

ralTH  = -ALT.i.CO  + 230.  + 24)5. 
lALTH  = RALTh  / 230.0 

35CC.  HEPFESE'ITS  THc  HIGHEST  RASTER 
UNIT  USED  IN  THE  DISPLAY  . THE  Y COORD. 
GOES  FROM  '>350  RU  TO  35  0 RU  I M53  Rll.S  ) 

OIFEh  = RALTH  - ( lALTH  230  ) _+  3500. 
HNDX  = lALTH  ♦ 1 
DIFFH  = OIFFH  - 230.0 

_ op  1250  J = 1,5  _ 

__IALTXH(J)  = lALTIHNCXl  _ __  _ _ _ 

IALHXY(J+1)  = DIFFH 

’if  (IALHXY(J+1)  .LT.  LCUR  ) GO  TO  1251 
DIFFH  = DIFFH  - 230. 

lALhXYU)  = lALH^Y(l)  +1  

HNDX  = HNDX  +1 

1250  CONTINUE  _ _ , ___ 

1251  CONTINUE 


co'mpute  Y f’or  ACCELERCM'ETER  ( G-~L0AD  1 
AND  CCNVERT  TO  RASTER  UNITS 

RGLUAO  = KGLOO 
I ACC Y (11  = 0 

IF  I ABSt  Rr7LJAD  l_.LT-  0.01)  RGLOAH  = .01 


31C5  = 230  * 16  - 575 
16  ccopESENTS  THE  NUMBER  OF  ENTRIES 
TO  ENTRY  CONTAINING  THE  ZERO  . 

230  REPKESFiTS  230  RASTER  UMITS  BF.TWEEN 


00C07730 

C0007740 

03007750 

00007760 

00007770 

00007780 

00007700 

0COC78OO 

00007810 

00007620 

C0007830 

00007840 

00007850 

00007860 

OC00787C 

QOOC7B80 

000C7890 

CC0079C0 

OPOC7910 

DG0C7920 

C0007930 

CPOC7940 

CC0C795Q 

00007960 

00007970 

C00C798C 

C0007990 

ooooeooo 

ocor.8010 

CC0C6020 
OCC08030 
00008040 
00C08050 
C0008060 
00008070 
OOuC  80  6C 
00008090 
0C0P8100 

opooeiio 
00008120 
0O0C813O 
CC0OB140 
00008150 
CrOCRlBO 
0OC08?  70 
00008180 
or&C8i90 
000^6200 


or>ooor)Oor>or>,  o oooo  | o r>  o o oooon  | r»oooo 
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DATE  = 7A?75 
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EACH  ENTRY  CN  THE  DISPLAY 
57*=  IS  THE  NJMBER  OF  RASTER  UNITS  TO  THE 
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iACCY(l)  = lACCYIl)  + 1 
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351  CONTINUE 
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lAOAY(l)  =0  ~ 
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This  appendix  documents  the  FORTRAN  computer  program 
written  to  demonstrate  the  CPM  technique.  The  details  of  the  computer 
program  are  given  and  a listing  is  included.  Figure  B~1  shows  a 
functional  block  flow  chart  for  the  program. 

The  initial  setup  portion  of  the  program  contains  the  decla- 
ration of  all  matrices  and  of  variables  with  abnormal  type  attributes. 

Certain  arrays  are  initialized  to  zero.  The  initial  time  is  set  to  zero 
and  the  numerical  integration  step  size  is  set  to  0.5  seconds. 

The  next  section  of  coding  contains  read  statements  which 
input  from  cards  as  follows:  the  initial  state  vector  X(0)  and  the  position 

of  the  aircraft  with  respect  to  the  earth  Xgj  the  reference  state  vector 
Xp;  the  reference  control  vector  Ur;  the  diagonal  elements  of  the  Q and 
R matrices;  the  initial  control  settings  (U-j  ,U2>  arid  Ug);  the  initial 
setting  for  the  autopilot’s  normalized  percent  throttle;  a program  control 
switch  named  ISWT;  and  the  number  of  iterations  desired  for  program 
execution,  a parameter  called  ITIME.  Table  B-1  presents  the  input  data 
card  structure  for  the  eight  input  cards  needed  for  the  program.  Note 
that  if  ISWT  is  greater  than  zero  the  autopilot  controls  the  aircraft, 
but  if  ISWT  is  set  less  than  zero,  the  aircraft  motion  is  governed  by 
the  approximate  optimal  control . In  this  section  of  coding  certain  off- 
diagonal  elements  of  the  Q matrix  were  set  equal  to  non-zero  values. 

Next  the  program  prints  the  initial  state  vector,  reference 
state  vector,  reference  control  and  diagonal  elements  of  the  Q and  R 
matrices . 

The  next  step  is  the  main  loop  of  the  program  in  which 
valijes  of  the  elements  of  the  F and  G matrices  are  computed  from  the 
present  value  of  the  state  vector.  The  four  intermediate  variables  CLl  , 
CL2,  L and  AL1  are  computed  in  this  process,  according  to  the  equations 
of  Section  5. 

The  next  section  of  coding  implements  an  iterative  technique 
to  obtain  a numerical  solution  for  the  elements  of  the  matrix  KfX),  which 
is  the  positive  definite  symmetric  solution  to  the  algebraic  Riccati  equation. 
Appendix  C contains  a detailed  discussion  of  the  numerical  methc-d  used  to 
compute  K(X).  This  is  the  longest  section  of  coding  in  the  computer  pro- 
gram and  consumes  the  major  portion  of  the  execution  time. 

The  next  section  of  coding  contains  write  statements  to 
print  some  intermediate  results.  The  G matrix;  F matrix;  the  matrix  Fq 
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CARD 

1 

2 

3 

4 
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DATA 

Initial  values  of  state  vector 
X(0)  and  of  ><^(0) 

Reference  state  vector 

I X 

Reference  control  vector 

The  seven  diagonal  elements 
of  Q matrix 

The  three  diagonal  elements 
of  R matrix 


FIELDS 

T\  PE 

8(F10. 5) 

Real 

7(F10.5) 

Real 

3(F10.5) 

Real 

/(F10.5) 

Real 

3(F10.5) 

Real 

6 Initial  control  settings  U^(0),  3(F10,5)  Real 

UgCO),  Ug(0) 

7 Initial  setting  for  auto-pilot  (F6.2)  Real 

normalized  percent  throttle 

UPT  L(3) 


8 Program  control  pai'ameters  (12,  16)  Integer 

ISWT  and  ITIME  where 
ISWT  = .■>  O for  auto-pilot 

<C  O for  optimal 


ITlME  = number  of  interations 
2 ITIME  = total  number  of 
seconds  of  run 


used  to  start  the  iterative  method  of  obtaining  matrix  K;  the  parameters 
CL1  , CL2,  L and  AL1;  and  the  matrix  K are  printed. 

The  next  several  sections  of  coding  calculate  the  approxi- 
mate optimal  control  in  the  following  manner.  First,  the  approximate 
optimal  control  vector  is  computed  and  the  control  values  printed.  Next, 
appropriate  limits,  as  discussed  in  Section  5,  are  applied  to  the  approx- 
imate optimal  control  to  conform  to  realistic  stick  and  throttle  positions. 
Finally,  the  approximate  optimal  controls  after  the  limits  have  been 
applied  are  printed. 

The  approximate  solution  to  the  Riccati  equation  (K)  is 
evaluated.  This  is  done  by  computing  the  left  hand  side  to  Equation  5.23 
which  should  equal  zero.  The  result  of  this  evaluation  is  then  printed. 

Next,  the  value  of  the  control  variables  are  computed  using 
the  autopilot  functions  described  in  Section  5.4.  This  solves  the  "non- 
optimal"  autopilot  aircraft  control  equations.  These  autopilot  control 
values  are  then  printed. 

The  following  section  of  coding  calculates  the  CPM  when 
■ the  autopilot  equations  are  used.  The  control  error,  (the  approximate 

' optimal  control  subtracted  from  the  autopilot  generated  control),  is 

computed  followed  by  calculation  of  the  CPM. 

If  ISWT  is  less  than  zero,  the  approximate  optimal  con- 
trols are  used  and  the  program  goes  to  the  section  of  coding  that 
calculates  the  new  state  vector.  If,  however,  ISWT  is  greater  than 
zero,  the  values  for  the  CPM  and  the  control  error  are  printed  and 
the  autopilot  generated  controls  are  used.  The  aircraft  state  vector 
- will  then  reflect  the  impact  of  these  non-optimal  autopilot  inputs  when 

I the  program  updates  the  location  of  the  aircraft. 

\ 

) Next,  new  values  of  the  aircraft  variables,  are  obtained 

I by-  numerical  integration.  Rectangular  integration  is  used,  with  a fixed 

• ( step  size  of  0.5  seconds.  The  values  of  the  new  aircraft  variables 

I 

j and  time  are  then  printed. 

Finally,  the  program  determines  if  the  flight  calculation 
is  complete  .by  comparing  the  number  of  main  loop  iterations  to  the 
input  parameter  ITIME.  If  not,  the  program  returns  to  the  start  of 
the  main  loop  (Point  A in  Figure  E-1)  for  a new  iteration.  If  the 
number  of  iterations  exceeds  ITIME,  the  program  terminates. 


Extens  ive  use  is  made  by  the  main  program  of  three 
subroutines  documented  in  the  IBM  Scientific  Subroutine  Package: 

(1)  a matrix  inversion  subroutine  called  MINV  which  replaces  the 
square  input  matrix  by  its  inverse;  (2)  a general  matrix  product  sub- 
routine called  GMPRD  that  multiplies  any  two  conformable  matrices 
and  stores  the  result  in  a different  matrix;  and  (3)  a matrix  addition 
subroutir.3  called  MADD  that  stores  the  linear  combination  of  two 
matrices  of  the  same  dimensions  in  a different  matrix. 

The  following  is  a listing  of  the  FORTRAN  program  just 

described . 
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APPENDIX  C 


AN  ITERATIVE  TECHNIQUE  FOR 
SOLUTION  OF 

ALGEBRAIC  RICCATI  EQUATIONS 


. 1 


0-1 


An  iterative  technique  for  computing  an  approximate 
solution  to  the  algebraic  matrix  Riccati  equation: 

Q + f'*'  K + KF  - K GR~^  g"^  K = 0 (C-1) 

i 

is  described  in  this  section.  \ 

This  equation  arose  in  the  development  of  the  approximate 
optimal  control  law  for  Segment  4 of  the  mission,  as  presented  in 
Section  5.2.  The  technique  presented  is  an  extension  of  Newton's 
method  first  developed  by  Kleinman  (1968  and  1970)  and  extended  by 
Sandell  (1974)  for  algebraic  Riccati  equations.  The  technique  calculates 
an  approximate  solution  to  the  feedback  gain  matrix  K which  was  imple- 
mented in  the  computer  program  as  described  in  Appendix  B. 

1.0  CONDITIONS  FOR  A UNIQUE  POSITIVE  DEFINITE  SOLUTION 

TO  THE  ALGEBRAIC  RICCATI  EQUATION 

' As  in  Section  5,  it  is  assumed  that  the  constant  matrices 

' R and  Q are  chosen  such  that  they  are  both  positive  definite  symmetric 

matrices.  The  matrix  K is  defined  to  be  a (7  x 7)  symmetric  matrix.  ^ 

It  has  been  shown  (Bryson  and  Ho,  1967,  Athans  and  Falb,  1966,  and 

Anderson  and  Moore,  1971)  that  a unique  positive  definite  solution  exists 

for  Equation  C-1  if  the  matrix  pair  F,  G are  controllable,  i.e.,  if  for 

the  system  of  Section  5.1  the  (7  x 21)  matrix 

; M = [ G ' FG  ■ . . . ■ F®  G]  , , 

■ '!  ' 

has  rank  7.  For  the  state  equations  of  Section  5.1,  it  was  assumed  that  ^ 

this  condition  could  be  met  for  every  value  of  X in  the  range  of  interest. 
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2.0  NENATTON'S  METHOD 

Kleinman  (1968)  has  applied  Newton's  method  in  function 
space  to  develop  an  iterative  solution  to  the  algebraic  matrix  Riccati 
equation.  A summary  of  the  results  is  presented.  Kleinman  (1968) 
contains  the  formal  proofs  for  this  technique. 

Let  Kj,  i = 0,  1,  2,  ...  be  the  sequence  of  unique 
positive  definite  symmetric  matrix  solutions  to  the  matrix  equation: 


O 


F."''  K.  + K,  F.  + Q + R T. 

i i 1 i i i 


(C-2) 


where  T.  is  the  matrix  computed  from 


T = r"^  K.  ^ 

i 1-1 


(C-3) 


and  F. 

i 


is  the  matrix  computed  from 


F = F - G T.  (C-4) 

i i 


ij 


I 


Choose  a starting  matrix  such  that  the  matrix  F^, 


i.e. , 


F 


O 


F-GTo 


(C-5) 


has  all  of  its  eigenvalues  with  negative  real  parts.  Then  the  sequence 
of  solutions  K|  will  approach  the  unique  positive  definite  symmetric 
solution  K to  Equation  C-1  in  the  limit  as  the  index  i tends  toward 
infinity  (Kleinman,  1968),  that  is 

lim  K.  = K 

i 

i ->  00  (C-6) 
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Thus  an  approximation  to  the  matrix  K can  be  found  by  iterating 
through  the  above  procedure  a finite  number  of  times . 


A starting  value  for  the  matrix  T can  be  generated  in 
the  following  manner  (Kleinman,  1970,  and  Sanoell,  1974).  Let 
be  given  by 


L = o'"  B-' 


where  the  matrix  B is  given  by 


-Ft  -F”^t 

e GG  e dt 


The  upper  limit  of  integration,  time  t^  , is  arbitrary.  The  matrix 
B can  be  computed  by  using  the  series  expansion  for  the  exponential 
term  in  Equation  (C-8),  i.e., 

= E ih 

k=0 

Equation  C-9  is  truncated  at  some  appropriate  number  of  terms  and 
Equation  C-8  is  numerically  integrated.  Since  the  system  is  assumed 
controllable,  the  matrix  E will  have  an  inverse  and  the  value  of  Tq 
will  yield  an  Fq  which  has  all  of  its  eigenvalues  with  negative  real 
parts . 

In  order  to  use  this  technique.  Equation  C-2  must  be 
solved  for  Kj  for  each  iteration.  A series  solution  to  Equation  C-2 
was  developed  for  this  contract  based  on  a technique  proposed  by 
Smith  (1968)  to  solve  the  matrix  equation  XA  + BX  = C.  Let 


C.  = Q + T. 

i i 


Then  Equation  C-2  becomes: 


F.  K.  + K.F.  = -C, 

i i i i i 


Adding  and  subtracting  from  the  lefthand  side  of  Equation  C-1 1 a 
factor  c times  the  matrix  Kj,  where  c is  a positive  scalar  parameter , 

Equation  C-1 1 can  be  put  into  the  form  of 

[F  ^ + c l]  K + K,  [F,  - £l]  = -C.  (C-12) 

i i i i I 

where  I is  the  identity  matrix.  Multiply  both  sides  of  Equation  C-12 
by  the  inverse  of  fFj  - fl].  Since  Fj  has  negative  eigenvalues 
(Kleinman,  1968),*  can  be  chosen  such  that  the  indicated  inverse  exists. 

Then  Equation  C-12  can  be  put  into  the  form 

K.  - [€I  + F."^]  K.  [€I  - F,]“’  = C.  [£l  - F ]"^  (C-1 3) 

A necessary  and  sufficient  condition  that  Equation  C-1 3 has  a unique 
solution  for  each  C^  is  that  each  F^  be  a Hurwitzian  matrix,  i.e., 
all  eigenvalues  have  negative  real  parts  (Smith,  1968).  Since  F- 
will  have  all  its  eigenvalues  with  negative  real  parts,  this  condition 
is  met.  A series  solution  for  K.  which  is  convergent  is  given  by 

•<i  = L [«1  + C.[(€l  - F,)"’  ] J 

^ j-1 


3.0 


COMMENTS  ON  THE  ITERATIVE  SOLUTION  TECHNIQUE 


In  order  to  implement  the  computation  technique  on  a 
digital  computer,  several  approximations  are  required.  In  order  to 
obtain  a starting  value  Tq  for  the  method,  the  integral  in  Equation  C-8 
must  be  obtained.  A series  solution  given  by  Equation  C-9  is  used 
for  the  exponential . The  number  of  terms  in  this  series  must  be 
selected.  For  the  computer  program  discussed  in  Appendix  B,  the 
series  used  1 1 terms . An  integration  scheme  must  be  used  to  calcu- 
late matrix  B.  For  the  computer  program  described  in  Appendix  B, 
the  integration  time  interval  was  from  O to  1.5  seconds  and  rectangular 
integration  with  a step  size  of  0.1  second  was  used.  In  order  to  solve 
Equation  C-2  for  K|,  the  series  solution  given  by  Equation  C-14  is  used. 
Kleinman  recommends  ten  iterations  for  a good  approximation.  For  this 
method,  as  a first  cut,  we  have  used  20  iterations  through  the  total 
method,  i.e.,  i = 20. 

The  sequence  of  Kj's,  that  is,  Kq,  , K2,  ...  is  mono- 
tonically  convergent  from  above,  it  is  also  quadratically  convergent. 

Once  an  Fq  matrix  has  been  found  which  has  negative  real  parts  for 
its  eigenvalues,  then  so  does  the  F^  matrix,  the  F2  matrix,  the  F3 
matrix,  etc.  In  order  to  use  Equation  C-14  as  an  approximate  solution 
for  the  matrix,  a value  of  e must  be  chosen.  For  the  computer 
program  described  in  Appendix  B,  the  value  of  € is  chosen  as  20. 

With  only  limited  experience,  it  was  found  that  e had  to  be  chosen 
greater  than  one  in  order  for  the  computer  subroutine  that  calculates 
the  inverse  to  be  numerically  well  behaved.  Further  investigation  into 
the  choice  of  parameters,  the  number  of  terms  that  should  be  taken  in 
each  series,  the  value  of  the  starting  matrix  B is  required  to  decrease 
computation  time.  This  technique,  however,  can  be  used  on  line.  After 
further  investigation  it  should  be  possible  to  simplify  this  method  to 
generate  a good  approximation  to  the  matrix  K while  requiring  shorter 
computation  time.  Figure  C-8  shows  a flow  chart  for  the  iterative 
solution  to  the  algebraic  Riccati  equation. 
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